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Preface 


The  integration  of  GPS  and  INS  allows  for  more  precise  position  and  velocity 
information  than  is  available  with  either  system  alone.  This  thesis  investigates  the 
possible  performance  improvement  with  GPS/INS  integration.  This  research  demon¬ 
strates  that  improvement,  and  shows  attempts  to  provide  verification  with  empirical 
data. 

The  most  important  tool  in  this  research  is  the  Mutimode  Simulation  for  Op¬ 
timal  Filter  Evaluation  (MSOFE)  software  package  developed  by  the  Avionics  Lab¬ 
oratory  at  Wright- Patterson  AFB,  OH.  This  tool  was  the  major  resource  used  to 
verify  the  truth  models,  predict  filter  performance,  and  implement  the  filter  with 
empirical  data. 

I  would  like  to  thank  Lt  Col  Lewantowicz  for  his  constant  push  to  obtain 
better  results.  His  help  in  analyzing  the  data  and  results  was  instrumental  to  my 
understanding  the  problems  I  was  facing.  I  would  also  like  to  thank  my  thesis 
committee  members,  Dr.  Maybeck  and  Capt  Paschall,  for  their  help  with  Kalman 
filtering  concepts  and  their  help  in  obtaining  a  better  look  at  the  problems  being 
encountered. 

The  students  in  the  1989-1990  navigation  sequence  receive  my  thanks  for  forc¬ 
ing  me  to  understand  the  concepts  being  used  and  the  many  uses  to  which  MSOFE 
can  be  put.  My  thanks  go  out  to  Capt  Britt  Snodgrass  and  Capt  Gregory  Johnson 
for  their  help  with  MSOFE  and  PROFGEN,  and  Capt  Barbara  Niblett  for  her  sup¬ 
port  and  help  in  proofreading  and  other  tasks  necessary  to  the  completion  of  this 
document. 

Finally,  I  would  like  to  thank  my  family  whose  constant  support  throughout 
this  effort  was  essential  to  its  completion. 


James  Lawrence  Hirning 
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Abstract 

This  research  develops  and  attempts  to  implement  a  Kalman  filter  integration 
of  a  Phase  III  Global  Positioning  System  (GPS)  five-channel  receiver  and  an  LN-94 
Inertia!  Navigation  System  (INS).  GPS  provides  highly  accurate  position  and  velocity 
information  in  low  dynamic  environments.  An  INS  provides  position  and  velocity 
information  with  lower  accuracy  over  long  periods  of  time,  but  it  is  highly  responsive 
in  dynamic  maneuvers  or  at  high  frequencies.  The  INS  has  the  added  advantage  of 
requiring  no  signals  external  to  the  vehicle  to  function.  The  integration  of  these  two 
systems  provides  more  precise  information  under  a  wider  variety  of  situations. 

A  truth  model  for  the  INS  is  verified.  A  GPS  error  model  is  developed  and 
combined  with  the  INS  model  to  provide  GPS-aided-INS  navigation.  This  model  is 
used  to  predict  baseline  performance  of  a  full-ordered  filter.  Attempts  are  made  to 
utilize  the  filter  with  empirical  data.  The  data  is  analyzed,  and  suggestions  are  made 
about  ways  to  account  for  the  errors  in  evidence.  Results  to  date  are  presented  and 
analyzed. 
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OPTIMAL  KALMAN  FILTER  INTEGRATION  OF 
A  GLOBAL  POSITIONING  SYSTEM  RECEIVER 
AND  AN  LN-94  INERTIAL 
NAVIGATION  SYSTEM 


I.  Introduction 


1.1  Background 

The  Global  Positioning  System  (GPS  )  is  a  navigation  system  which  provides 
highly  accurate  position  and  velocity  estimates  to  the  user  (5:144).  This  system 
consists  of  three  segments:  space,  control,  and  user.  The  space  segment  consists  of 
24  satellites  in  six  orbital  planes  which  receive  information  from  the  control  segment 
and  transmit  satellite  orbital  information  to  the  user  segment.  The  control  segment 
monitors  satellites  and  performs  updates  when  necessary.  The  user  equipment  re¬ 
ceives  signals  from  at  least  four  different  satellites  and  computes  user  position  and 
velocity  which  are  provided  to  the  user.  For  GPS  to  maintain  lock  on  the  signals, 
even  in  a  jamming  environment,  requires  that  the  bandwidth  of  the  receiver  be  quite 
narrow.  However,  GPS  performance  is  degraded  during  high  dynamic  maneuvers 
due  to  the  narrow  bandwidth  (6:2). 

An  Inertial  Navigation  System  (INS  )  provides  information  about  user  positio.. 
and  velocity  without  external  measurements.  The  INS  can  provide  the  same  type 
of  information  as  GPS  without  external  signals  but  with  a  lesser  degree  of  long 
term  accuracy.  Also,  the  vertical  channel  in  the  INS  is  unstable.  Errors  in  the 
INS  gyroscopes  and  accelerometers  cause  a  degradation  of  the  unit’s  performance. 
The  errors  grow  slowly  with  time.  As  a  result,  the  INS  can  provide  highly  accurate 
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position  and  velocity  data  for  short  periods  of  time.  This  high  frequency  response 
allows  the  INS  to  continue  providing  information  in  highly  dynamic  environments 
(6:3). 

The  integration  of  these  two  systems  provides  many  advantages.  The  first 
of  these  advantages  is  to  maintain  high  accuracy  position  and  velocity  information 
during  all  phases  of  flight.  Other  potential  benefits  of  this  integration  include  an 
increase  in  anti-jamming  performance  of  the  GPS  User  Equipment  (GPSUE  ),  aiding 
the  reacquisition  of  satellite  signals  after  interruptions,  and  an  increase  in  ability 
to  track  satellites  either  with  adaptive  tracking  techniques  or  with  steerable  beam 
antennas  (5:144-145). 

1.2  Research  Objective 

The  objective  of  this  research  is  to  integrate  an  LN-94  INS  and  a  GPS  receiver 
using  a  single  Kalman  filter.  A  Kalman  filter  is  a  computer  algorithm  which  estimates 
the  errors  in  the  systems  from  which  it  receives  measurement  inputs.  The  results  of 
this  integration  are  to  be  used  as  a  truth  model  baseline  from  which  to  compare  a 
two-Kalman-filter  integration  of  the  LN-94  INS  and  GPS  receiver  and  reduced  order 
filters  based  on  the  truth  model.  The  two-filter  integration  scheme  is  dicussed  in 
Section  1.3. 

1.3  Current  GPS/INS  Integration  Techniques 

Two  methods  of  integrating  GPS  and  INS  have  been  suggested.  One  proposed 
method  uses  one  Kalman  filter  internal  to  the  GPSUE  and  a  second  Kalman  filter 
containing  the  INS  and  GPS  filtered  output  (6:1).  This  configuration  is  illustrated  in 
Figure  1.1  This  approach  has  received  much  study  because  of  current  configuration  of 
GPSUE  for  Air  Force  aircraft.  The  second  method  proposes  to  integrate  the  systems 
optimally  through  the  use  of  a  single  Kalman  filter  (5:145).  This  approach  uses  the 
raw  pseudorange  information  and  is  generally  accepted  a3  the  analytically  better  way 
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Figure  1.1.  Two  Filter  GPS/INS  Integration  Scheme 


to  integrate  the  two  systems.  All  information  shared  between  equipment  onboard 
Air  Force  aircraft  is  transmitted  over  the  military  standard  1553  digital  bus  (MIL- 
STD-1553).  Phase  III  GPS  receivers  are  not  programmed  to  provide  the  necessary 
information  (raw  pseudorange  and  delta-range)  on  the  MIL-STD-1553  bus.  Hence, 
the  necessity  to  study  the  first  method  of  integrating  INS  and  GPS  equipment. 

1.3.1  Two  Filter  Implementation  Plessey  Avionics,  and  others,  have  already 
implemented  the  two-filter  configuration  (8:117).  Plessey  Avionics  actually  used 
three  different  integrating  filters,  each  for  a  different  dynamic  mode  of  operation. 
They  implemented  a  number  of  corrections  in  all  of  their  filters,  including  a  correction 
for  the  lever  arm  from  the  antenna  to  the  GPSUE  (8:120-121).  The  main  intent  of 
their  research  was  to  explore  improvement  in  anti-jamming  performance  of  the  GPS 
receiver  using  INS  aiding.  Under  highly  dynamic  maneuvers,  the  position  error 
growth  was  nearly  zero  even  with  only  two  satellites  being  tracked  (8:122  123). 

One  major  drawback  to  the  two-filter  implementation  is  a  degree  of  instability 
during  highly  dynamic  maneuvers  (6:1).  This  instability  is  attributed  to  two  ma¬ 
jor  sources:  the  vertical  channel  instability  of  the  INS  and  the  lack  of  correlation 
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Figure  1.2.  External  Single  Kalman  Filter  GPS/INS  Integration  Scheme 


information  between  the  two  systems.  The  INS  hac  an  inherent  vertical  channel 
instability  and  must  be  aided  by  altitude  information  typically  provided  by  a  baro¬ 
metric  altimeter,  but  this  device  does  not  totally  remove  the  instability.  Also,  the 
information  shared  by  the  two  Kalman  filters  may  be  highly  correlated.  With  the 
separation  of  the  GPS  and  INS  models,  information  about  this  correlation  is  lost. 
This  contributes  to  the  instability  of  the  overall  system  (6:4). 

1.S.2  Single  Filter  Implementation  Cox  discusses  an  approach  for  the  imple¬ 
mentation  of  the  single  filter  configuration  (5:145-146).  This  configuration  is  shown 
in  Figure  1.2.  Utilizing  Cox’s  approach,  Texas  Instruments  has  implemented  a  sim¬ 
ilar  system  using  their  own  GPS  receiver  and  INS  (23:1).  They  also  used  a  lever 
arm  correction  in  their  system.  Their  integration  of  the  two  systems  provided  an 
improvement  in  the  accuracy  of  position  and  velocity  data.  The  position  error  was 
maintained  below  ten  meters  and  the  estimated  velocity  was  within  50  millimeters 
per  second  of  the  actual  velocity.  A  test  of  the  receiver  was  performed  to  guide 
an  aircraft  in  a  terrain  following  maneuver.  The  data  from  this  test  also  showed  a 
marked  improvement  over  either  GPS  or  INS  alone  (23:8). 
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Figure  1.3.  Internal  Single  Kalman  Filter  GPS/INS  Integration  Scheme 

A  second  approach  to  the  single  filter  configuration  was  implemented  by  The 
Charles  Stark  Draper  Laboratory,  Inc.  utilizing  a  Rockwell- Collins  Phase  II  GPS 
receiver  (22:124).  Here,  the  internal  filter  of  the  GPSUE  was  used  to  process  all 
the  information  provided  by  the  GPS  receiver  and  the  INS.  This  implementation 
is  illustrated  in  Figure  1.3.  The  GPSUE  filter  has  very  crude  approximations  in  its 
filter  models  to  allow  for  its  use  with  a  number  of  different  INS  units.  With  a  Phase  II 
receiver,  it  is  possible  to  change  the  noise  strength  models  to  model  a  particular  INS 
more  accurately  (22:124).  Draper  Labs  used  many  different  noise  strengths  to  tune 
the  filter  for  their  INS.  With  the  proper  tuning,  the  position  error  was  reduced  by  29 
percent,  and  a  reduction  in  velocity  error  by  a  factor  of  five  was  obtained  (22:129). 

The  single  filter  configuration  of  the  GPS  and  INS  integration  is  attractive  but 
is  difficult  to  implement  due  to  current  equipment  configurations.  The  GPS  does  not 
have  the  ability  to  output  the  necessary  range  and  range-rate  information  onto  the 
military  standard  1553  (MIL-STD-1553  )  Data  Bus.  This  problem  severely  limits 
the  options  available  to  perform  the  integration.  If  the  internal  filter  is  to  be  used, 
it  would  have  to  be  tuned  for  each  different  type  of  Air  Force  INS.  This  problem  is 
not  insurmountable,  but  it  may  be  difficult  to  overcome  because  of  the  number  of 
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different  INS  units  currently  in  use. 


1.4  Specific  Research  Objectives 

This  research  emphasizes  the  development  and  implementation  of  a  single 
Kalman  filter  method  for  integrating  GPS  and  INS.  Key  milestones  are  develop¬ 
ing  and  validating  the  LN-94  truth  model,  combining  the  GPS  truth  model  with  the 
LN-94  model,  developing  a  Kalman  filter  for  the  total  system,  and  implementing 
and  validating  the  Kalman  filter  on  the  Sun  workstation.  Specifics  of  the  research 
objectives  are  given  below. 

I.4.I  LN-94  Truth  Model  The  LN-94  truth  model  is  developed  using  infor¬ 
mation  provided  by  Litton  (14)  and  is  validated  using  the  Multimode  Simulation 
for  Optimal  Filter  Evaluation  (MSOFE)  software  developed  at  the  Air  Force  Wright 
Aeronautical  Laboratories  (AFWAL)  (4).  Results  of  a  covariance  propagation  simu¬ 
lation  are  compared  to  the  results  from  a  Monte  Carlo  analysis  performed  by  Litton. 

1.4.9  GPS  Truth  Model  The  GPS  truth  model  is  added  to  the  LN-94  truth 
model  on  MSOFE.  The  GPS  model  was  developed  by  Capt  Joseph  I<.  Solomon  (20). 
This  truth  model  has  not  been  validated  against  a  known  standard.  Hence,  it  is 
expected  that  some  tuning  will  be  necessary  when  this  model  is  used  as  a  filter  with 
empirical  data.  The  two  truth  models  are  combined,  and  an  MSOFE  covariance 
analysis  is  performed  to  predict  performance  of  an  operational  system. 

1.4.3  Kalman  Filter  Development  and  Implementation  The  Kalman  filter  is 
developed  on  a  VAX  8650,  and  it  is  implemented  on  the  same  VAX  8650  and  on  a 
Sun  workstation.  A  GPS  receiver  and  LN-94  INS  are  optimally  integrated  using  a 
MIL-STD-1553  data  bus  and  an  RS-422  port  installed  on  the  Sun.  The  1553  data 
bus  is  used  primarily  for  receiving  information  from  the  INS.  The  RS-422  port  is 
utilized  to  obtain  data  from  the  GPS  receiver.  This  requires  writing  software  to 
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allow  the  Sun  to  collect  the  data  through  the  RS-422  port. 


I.4.4  Kalman  Filter  Validation  Validation  of  the  Kalman  filter  is  performed 
by  operating  the  filter  on  the  Sun  workstation  using  empirical  data.  The  results  are 
compared  to  the  MSOFE  performance  prediction. 

1.5  Summary 

A  brief  discussion  is  provided  about  GPS  and  INS.  Different  methods  of  in¬ 
tegration  of  GPS  and  INS  as  implemented  by  three  different  groups  are  described. 
Then,  the  specific  objectives  for  this  research  are  discussed. 

1.6  Overview 

1.6.1  Chapter  2  Chapter  2  provides  the  theory  necessary  to  this  research. 
Reference  frames,  coordinate  transformations,  communication  with  equipment,  and 
Kalman  filtering  are  among  the  topics  presented. 

1.6.2  Chapter  3  Chapter  3  discusses  the  development  and  verification  of  the 
truth  model  used  for  the  INS  Kalman  filter.  The  results  of  two  different  navigation 
simulations  are  compared  to  information  provided  by  Litton  Guidance  and  Control 
Systems. 

1.6.3  Chapter  4  Chapter  4  considers  the  design  of  the  GPS  truth  model  and 
its  integration  with  the  INS  truth  model.  A  baseline  simulation  with  which  to 
compare  filter  performance  with  empirical  data  is  presented. 

1.6.4  Chapter  5  Chapter  5  delves  into  empirical  data  collection  and  filter  op¬ 
eration  with  empirical  data.  Problems  with  filter  operation  and  attempts  to  correct 
for  unexpected  errors  are  presented. 


1,6.5  Chapter  6  Chapter  6  presents  conclusions  and  recommendations.  Con¬ 
clusions  from  the  information  presented  and  recommendations  for  further  study  are 
discussed. 
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II.  Theory 

2.1  Nomenclature  Conventions 

Different  type  styles  are  used  throughout  the  text  to  identify  scalars,  vectors, 
and  matrices.  Normal  and  italics  text  are  used  for  scalar  variables  (i.e.  Xn).  Vectors 
are  identified  with  lowercase  boldface  text  (i.e.  x).  Uppercase  boldface  is  utilized  for 
matrices  (i.e.  C£).  A  superscript  on  a  boldface  character  (xn)  normally  denotes  the 
reference  frame  in  which  that  variable  is  expressed.  However,  a  superscript  T  can 
be  used  to  mean  the  transpose  of  a  vector  or  matrix,  or  the  t  may  refer  to  the  true 
reference  frame,  described  later.  To  differentiate  between  these  two  superscripts,  on 
full  vectors  or  matrices,  a  boldface  lowercase  superscript  (x4)  indicates  a  reference 
frame,  and  a  normal  or  italics  uppercase  superscript  (xr)  indicates  the  vector  or 
matrix  transpose. 

2.2  Reference  Frames 

The  LN-94  INS  works  in  six  different  reference  frames:  earth-centered  earth- 
fixed  (ECEF  ),  navigation,  true,  computer,  platform,  and  body.  The  GPSUE  uses 
two  frames  of  reference:  earth-centered  earth-fixed  and  navigation.  In  order  to  model 
the  two  systems  properly,  it  is  important  to  understand  the  reference  frames  used. 

2.2.1  Earth-Centered  Earth-Fixed  Frame  The  earth-centered  earth-fixed 
frame  has  its  origin  at  the  center  of  the  earth.  The  Litton  ECEF  frame  ( Xi ,  V}, 
Zt  )  is  different  from  the  ECEF  frame  utilized  by  GPSUE  ( Xg ,  F,,  Zg  ).  These 
frames  are  illustrated  in  Figure  2.1.  In  the  Litton  frame,  the  Yi  axis  points  along 
the  earth’s  spin  axis.  Litton ’s  Z|  axis  points  towards  the  intersection  of  the  Prime 
(Greenwich)  Meridian  and  the  equator.  The  Xj  axis  in  Litton’s  ECEF  frame  is 
rotated  90  degrees  east  horn  the  Z|  axis  along  the  equatorial  piane  to  complete  a 
right-handed  coordinate  system.  The  ECEF  frame  used  by  GPSUE  has  its  axes 
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Y,  =  Z, 


Figure  2.1.  Litton  and  GPS  ECEF  Frames. 


aligned  with  those  of  the  Litton  ECEF  frame.  However,  the  GPSUE  ECEF  frame 
has  its  Xs  axis  aligned  with  the  Zi  axis.  The  Y,  axis  is  aligned  with  the  Xi  axis,  and 
the  Z,  axis  is  aligned  with  Litton’s  Yi  axis. 


2.2.2  Navigation  Frame  The  navigation  frames  (X„,  Yn,  Zn  )  used  by  the 
two  systems  are  the  same.  The  axes  are  oriented  to  implement  the  East,  North,  Up 
frame.  In  this  frame,  the  Xn  axis  points  east,  the  Yn  axis  points  north,  and  the  Zn 
axis  points  in  the  direction  of  the  local  vertical.  For  the  GPSUE,  the  origin  of  the 
frame  is  located  at  the  antenna.  The  origin  of  the  INS’s  navigation  frame  is  defined 
within  the  INS. 


2.2.3  True  Frame  The  true  frame  (X{,  Yt,  Zt)  is  a  wander  azimuth  reference 
frame.  The  true  frame  is  rotated  counterclockwise  about  the  Z„  axis  by  a  wander 
angle  at  which  varies  with  time  and  aircraft  position.  When  a(  =  0,  the  true  frame 
is  aligned  with  the  navigation  frame. 
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X, 

Figure  2.2.  Navigation,  True,  and  Computer  Frames. 

2.2.4  Computer  Frame  The  computer  frame  (Xc,  Yc,  Ze  )  is  a  wander  az¬ 
imuth  frame  also  and  is  the  frame  which  the  computer  actually  implements.  The 
computer  frame  is  rotated  by  an  angle  of  ae  about  the  Zn  axis.  When  ac  =  0,  the 
computer  frame  is  aligned  with  the  navigation  frame.  The  computer  wander  angle, 
ac,  differs  from  a(  because  the  computer  frame  is  the  frame  which  the  INS  is  actually 
implementing;  whereas,  the  true  frame  is  the  frame  which  the  INS  is  attempting  to 
implement.  With  no  errors,  the  computer  and  true  frames  are  aligned,  and  ae  is  the 
same  as  ort.  The  navigation,  true,  and  computer  frames  are  shown  in  Figure  2.2. 

2.2.5  Platform  Frame  The  platform  frame  has  its  origin  at  the  INS  and  is 
misaligned  from  the  true  frame  by  three  small  attitude  error  angles  ( b<pt,  6<t>y,  6<f>t  ). 
When  the  attitude  error  angles  are  all  zero,  the  platform  is  aligned  with  the  true 
frame. 
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2.2.6  Body  Frame  The  body  frame  (Xb,  VJ,,  Zb  )  has  its  origin  at  the  aircraft 
center  of  mass.  The  Xt,  axis  is  parallel  to  the  fuselage  of  the  aircraft  and  points 
towards  the  nose  of  the  aircraft.  The  Yb  axis  is  parallel  to  the  right  wing  of  the 
aircraft.  The  Zb  axis  points  through  the  floor  of  the  aircraft  to  complete  the  right 
handed  coordinate  system.  The  body  frame  is  illustrated  in  Figure  2.3. 

2.3  Coordinate  Transformations 

Coordinate  transformations  are  required  throughout  the  INS  and  GPS  error 
model.  Calculations  with  vectors  require  that  all  the  vectors  be  expressed  in  the 
same  frame.  Since  not  all  vectors  are  expressed  in  the  same  frame,  it  is  necessary  to 
transform  them  into  a  common  frame. 

2.8. 1  Vector  Representations  Vectors  can  be  expressed  in  any  of  the  reference 
frames  described  earlier.  Vector  notations  used  in  this  text  and  their  associated 
frames  are  shown  below. 

x*  Vector  in  ECEF  frame 
xn  Vector  in  navigation  frame 
x*  Vector  in  true  frame 
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xc  Vector  in  computer  frame 
xp  Vector  in  platform  frame 
xb  Vector  in  body  frame 


2.3.2  Attitude  Error  Angles  The  true,  computer,  and  platform  frames,  im¬ 
plement  nearly  the  same  frame.  The  platform  frame,  as  discussed  earlier,  is  mis¬ 
aligned  from  the  true  frame  by  small  attitude  error  angles  ( 8<j>x ,  8<f>y ,  8<f>x).  The 
relationship  between  these  two  frames  is: 

xp  =  [I  +  ^]xt  (2.1) 

where 

0  8<f>x  —8<f>v 

8$  =  -8<f>x  0  8<f>x  (2.2) 

8<f>y  —8<}>x  0 

The  computer  frame  is  also  misaligned  from  the  true  frame  by  small  attitude  angle 
errors  (S9.e,  88y ,  86 x  ).  The  relationship  between  the  computer  and  true  frames  is: 

xc  =  [I-f^0]xt  (2.3) 


where 


8®  = 


0 

-80, 

89y 


89, 

0 

-89x 


-89y 

89x 

0 


(2.4) 


2.3.8  Direction  Cosine  Matrices  Vectors  expressed  in  the  ECEF,  navigation, 
true,  computer,  or  body  frame  can  be  transformed  to  a  different  frame  by  use  of 
direction  costa?  matrices.  These  matrices  allow  transformations  of  vectors  between 
frames  which  are  related  to  each  other  through  axial  rotations.  Direction  cosine 
matrices  (DCMs)  are  given  in  the  form  C£  .  The  subscript  indicates  the  frame  in 


which  the  vector  is  given,  and  the  superscript  indicates  the  frame  into  which  the 
vector  is  transformed.  The  direction  cosine  matrices  between  Litton’s  ECEF  and 
navigation,  navigation  and  true,  and  true  and  body  frames  are  shown  below. 


x1  =  Clnxn 


(2.5) 


where 


and 


cos  A 

—  sin  A  sin  $ 

sin  A  cos  $ 

0 

cos  $ 

sin  $ 

—  sin  A 

—  cos  A  sin  $ 

cos  A  cos  $ 

A  =  local  terrestrial  longitude 
$  =  local  latitude 


(2.6) 


The  DGM  for  the  transformation  from  the  true  to  navigation  reference  frame  is: 


x“  =  C?x‘ 


(2.7) 


where 


cos  at  —  sin  0 

sin  Q(  cos  at  0 

0  0  1 


(2.8) 


The  DCM  for  the  true  to  body  frame  is  obtained  from  Specification  for  USAF-15 
Inertial  Navigation  Set  (1)  and  is  presented  here: 


=  cjy 


(2.9) 
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where 


cos  $  cos  xp  sin  t? 

sin  (fi  sin  d  cos  xp  —  cos  v?  sin  xp  —  sin  cos  t? 

cos  sin  t?  cos  xp  +  sin  cos  xp  —  cos  cos  i? 

(2.10) 

and 

=  roll 
1?  as  pitch 
xp  =  yaw 

2.4  INS/GPS  Integrated  Laboratory 

The  purpose  of  the  integrated  laboratory  in  the  Department  of  Electrical  and 
Computer  Engineering  at  the  Air  Force  Institute  of  Technology  (AFIT)  is  to  allow 
students  to  test  their  filter  designs  using  empirical  data.  The  INS  is  the  Litton 
LN-94,  and  the  GPSUE  being  utilized  is  the  Rockwell-Collins  Receiver  3A. 

2.4.I  Hardxvare  The  LN-94  is  a  strapdown  INS.  It  has  three  accelerometers 
and  three  ring  laser  gyros  mounted  on  the  INS  platform,  which  has  no  motion  relative 
to  the  aircraft  except  for  vibrations  transmitted  by  the  vibration  isolator  mount.  A 
gyro  and  accelerometer  along  each  of  the  three  platform  axes  measure  rotations 
about  and  accelerations  along  the  respective  bodyframe  axes, 

The  GPS  Receiver  3A  is  a  five-channel  receiver.  Four  equations,  having  the 
three  position  components  and  time  as  unknowns,  are  used  to  determine  receiver 
position.  Solving  these  equations  requires  range  information  from  four  satellites. 
The  satellites  transmit  signals  at  two  frequencies.  The  LI  frequency  is  1575.42  MHz, 
and  the  L2  frequency  is  1227.6  MHz  (7:2).  Four  of  the  receiver’s  channels  are  used 
to  receive  and  decode  LI  signals  from  four  separate  satellites.  The  fifth  channel  may 
do  three  things.  It  may  receive  signals  from  a  fifth  satellite,  search  for  other  satellites 


cos  1?  sin  xp 

sin  (p  sin  t?  sin  xp  +  cos  v?  cos  xp 
cos  ip  sin  i?  sin  xp  —  sin  v?  cos  xp 
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to  obtain  alternative  constellations,  or  receive  L2  signals  from  one  of  the  satellites 
currently  being  used  by  the  other  channels  to  help  estimate  the  ionospheric  delay. 

8.4-2  INS  En'or  Mechanization  Equations  Terrestrial  navigation  using  iner¬ 
tial  sensors  involves  the  measurement  of  specific  forces  in  three  mutually  orthogonal 
axes.  In  the  LN-94  this  is  accomplished  by  accelerometers  mounted  in  such  a  way  as 
to  measure  specific  force  in  the  body  frame.  Measurement  t  from  the  gyros  are  used 
by  the  internal  computer  to  transform  the  specific  force  vector  to  the  true  frame.  The 
gravity  force  vector  is  computed  using  a  gravity  field  model  and  is  removed  from  the 
measurements,  and  the  measurements  are  compensated  for  Coriolis  and  centripetal 
accelerations.  The  resulting  acceleration  vector  is  integrated  with  the  appropriate 
initial  conditions  to  obtain  earth  referenced  velocity.  The  nonlinear  velocity  vector 
differential  equation  has  the  form  (9:13-1): 

i. 

v  =  a  +  c  -  7  (2.11) 

where 

a  =  Measured  specific  force 
c  as  Coriolis  and  centripetal  acceleration 
7  =  Gravity  vector 

The  velocity  is  transformed  to  the  3CEF  frame  and  is  integrated  to  determine  the 
system’s  position  in  terms  ot  latitude  ($),  longitude  (A),  wander  angle  (at),  and 
altitude  (h).  The  nonlinear  equations  have  the  form: 
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(2.12) 

(2.13) 

(2.14) 

(2.15) 

The  nonlinear  Equations  (2.11)  through  (2.15)  are  combined  to  form  a  nonlinear 
vector  differential  equation.  These  equations  are  supplied  for  analysis  purposes  only. 
They  can  be  expanded  in  a  Taylor  series  to  determine  the  error  characteristics  of  the 
system;  however,  this  is  not  done  here.  The  expansion  is  performed  about  a  nominal 
point  and  truncated  to  first  order.  The  nominal  linearization  point  generally  used  in 
navigation  applications  is  the  INS  data  corrected  by  Kalman  filter  estimated  errors. 
The  equations  for  the  nominal  point  are: 


$ 

A 

at 

h 


»P* 

sec  $ 


w-'  -  tan  $ 


•p* 


ip* 


Kn 


$  =  $.».  +  £$ 

(2.16) 

A  =  Ain,  +  h), 

(2.17) 

h  -  hi +  Sh 

(2.18) 

a<  =  «tm,  +  Sat 

(2.19) 

Engineers  at  Litton  augmented  the  basic  error  states  with  error  sources  specific  to 
the  LN-94  to  create  a  93-state  truth  model.  This  model  is  presented  in  Chapter  3, 
Appendix  C,  and  Litton  CDRL  No.  1002  (14). 

L.4.3  GPS  Error  Mechanization  Equations  The  GPS  satellites  transmit  two 
codes  on  the  LI  frequncy:  coarse  acquisition  (OA)  and  precision  (P)  codes.  The 
coarse  acquistion  code  is  utilized  by  the  receiver  to  obtain  lock  on  the  signal.  Then, 
the  receiver  switches  to  decoding  the  P-code  signal.  The  P-code  is  a  pseudo-random 
signal  which  repeats  every  267  days  (18:6).  Each  satellite  sends  a  different  portion 
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of  the  code.  The  receiver  determines  which  satellite  has  been  found  by  the  portion 
of  the  code  being  sent.  The  signal  is  time  tagged  by  the  satellite,  and  the  range  to 
the  satellite  (R)  is  calculated  by: 

R  —  C&t  as  c(tge,iellite  —  ^receiver)  (2.20) 


where 


c  =  vacuum  speed  of  light 


This  range  is  termed  the  pseudorange  because  it  has  not  been  corrected  for  errors. 
The  main  errors  in  the  pseudorange  are  user  clock  error,  code  loop  error,  and  at¬ 
mospheric  and  ionospheric  delay.  The  error  equations  used  were  developed  by  Capt 
Joseph  Solomon  in  a  special  study  for  EENG699  at  AFIT  (20).  The  development  of 
the  error  equations  is  presented  later. 


2.5  Equipment  Communications 

Operationally,  the  filter  operates  with  empirical  data.  This  requires  communi¬ 
cation  with  the  INS  and  GPS  receiver  to  obtain  the  data.  Communication  with  both 
units  is  accomplished  using  the  MIL-STD-1553  bus.  Additional  information  needed 
for  this  research  is  obtained  from  the  receiver  through  the  RS-422  instrumentation 
port. 


2.5.1  MIL-STD-1553  Bus  The  MIL-STD-1553  bus  is  the  only  communica¬ 
tion  link  between  avionics  equipment  onboard  the  aircraft.  Communication  on  the 
bus  is  controlled  by  a  bus  controller,  which  issues  commands  to  each  remote  terminal 
(RT)  to  transmit  or  receive  information  (12:1-35,1-36). 

The  data  that  an  RT  may  receive  or  transmit  is  programmed  in  the  units.  Each 
set  of  data  has  a  subaddress  number  associated  with  it  that  tells  the  RT  what  data 
is  contained  in  the  set.  Because  the  LN-94  and  GPS  receiver  are  both  designated  as 
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remote  terminals,  only  pre-specified  types  of  information  may  be  obtained  by  use  of 
the  MJL-STD-1553  data  bus. 

Here,  the  main  use  of  the  MIL-STD-1553  is  to  obtain  information  from  the  INS. 
The  information  necessary  for  input  to  the  filter  are  position,  velocity,  linear  accel¬ 
eration  vectors,  attitude  and  attitude  rates.  This  information  is  directly  available 
on  the  MIL-STD-1553  bus. 

2.5.2  Instrumentation  Port  In  contrast,  none  of  the  information  necessary 
for  the  GPS  filter  is  available  on  the  MIL-STD-1553.  The  only  method  for  obtaining 
the  “raw”  pseudorange  and  delta-range  data  is  through  the  instrumentation  port  on 
the  GPSUE. 

Information  available  on  the  instrumentation  port  has  also  been  predefined  in 
data  sets  called  blocks.  Operation  of  the  instrumentation  port  is  much  like  that  of 
the  MIL-STD-1553,  but  only  two  devices  can  be  connected  using  the  required  RS-422 
communication  protocol.  Intermetrics  Incorporated  has  written  a  software  package 
called  PC  Buffer  Box  which  runs  on  an  IBM  PC-AT  through  which  it  is  possible  to 
obtain  the  information  necessary  for  the  filter. 

2.6  Kalman  Filter  Equations 

A  Kalman  filter  is  utilized  to  estimate  the  errors  committed  by  the  LN-94  and 
GPS  Receiver  3A.  The  error  states  for  the  INS  are  those  developed  by  Litton  (14). 
The  error  states  for  the  GPS  receiver  were  developed  by  Capt.  Solomon,  as  stated 
previously  (20). 

The  Kalman  filter  equations  are  implemented  using  a  simulation  and  analy¬ 
sis  software  package  called  MSOFE  (4)  which  is  discussed  later.  The  form  of  the 
differential  and  measurement  update  equations  used  by  MSOFE  are  described  here. 
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The  stochastic  differential  equations  have  the  form: 

£x(t)  =  F(t)Sx(t)  +  G(t)w{t)  (2.21) 

£{w(<)}  =  0  (2.22) 

i?{w(<)wT(<  +  r)}  =  Q(t)6(r)  (2.23) 

where  the  function  E{}  is  used  to  mean  the  expected  value  of  the  argument  inside 
the  braces.  The  states  in  the  INS  truth  model  are  error  states.  Thus,  they  are 
referenced  in  the  equations  as  6x.  The  error  states  are  defined  as  the  difference 
between  the  actual  and  INS  measured  states. 

The  error  state  vector  Sx  and  its  associated  covariance  matrix  P  are  propagated 
forward  in  time  between  measurements  by  integrating  the  equations  (16:275): 

&(*|«i-t)  =  F(0&M*-i)  (2.24) 

P(<|f,-i)  =  F(l)P(l|ii-.)+P((|lf-.)FT(()  +  G(()Q(<)GI'(‘)  (2-25) 

The  “hat"  (6ffc  )  indicates  that  the  quantity  is  an  estimate  given  by  the  filter.  In 
#  # 

addition,  the  term  &r(<|<,_i)  indicates  the  estimate  of  Sx  at  time  t  given  knowledge 
available  about  <Sz(tJi,_j)  through  time  f,_i.  These  equations  are  integrated  from 
time  to  using  the  initial  conditions: 

£x(0)  =  Sxq  (2.26) 

P(0)  =  P0  (2.27) 

The  INS  error  states  are  assumed  to  be  zero  mean  for  lack  of  a  priori  information. 

Hence,  the  vector,  Sx o,  is  a  zero  vector.  The  elements  of  the  matrix,  Po,  are  defined 
in  Appendix  B,  and  the  values  of  Pq  indicate  the  extent  to  which  the  values  in 
Sx o  are  believed  to  be  correct.  Updating  the  state  estimates  with  measurements  is 
performed  to  improve  the  quality  of  the  state  estimates.  Measurements  have  the 
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following  form  (16:205): 


E{y(U)} 

E{y(U)vTm 


H(ti)6x(U)  +  v(*<) 

0 

R(f.)  U  =  tj 
,0  Ut  tj 


(2.28) 

(2.29) 

(2.30) 


The  measurements  are  used  by  the  filter  to  update  the  state  estimates.  The  mea¬ 
surement  update  equations  are  (16:275): 


K (U)  =  P(f-)Hr(<,)  [H(t,)P(<r)HT(t<)  +  Rft)!”1  (2.31) 

ik(tt)  =  tx(t-)  +  K((,)  (iz(l,)  -  H(l,)<5x(f-)]  (2.32) 

P((t)  =  P(i-)  -  K((,)H(1,)P(|-)  (2.33) 


The  measurement  updates  are  actually  performed  using  the  UD  covariance  factoriza¬ 
tion  update  algorithm.  This  algorithm  is  discussed  by  Maybeck  (16:392-394).  The 
algorithm  actually  computes  the  separate  factors  U  and  D  rather  than  P  ,  where 
these  matrices  are  interrelated  by: 


P  =  UDU7  (2.34) 

U  is  an  upper  triangular  matrix,  and  D  is  diagonal.  The  nth  columns  of  U  and  D 
are  calculated  by: 


Enn  —  Pnn 

{1  t  as  n 

(2.35) 

Pin/ Dnn  *  —  Tl  —  l,n  —  2,  ...,1 
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The  remaining  columns  are  calculated  for  j  =  n  -  1,  n  —  2, . . . ,  1  by: 


Uii 


Pa-  ±  DkkUjk 

k*j+ 1 

[Pa  -  ZLi+i  DM^/Dh  i  m  j  -  l,  j  -  2, . . . ,  l 

■  1  t « j  (2.36) 

0  *  >  j 


After  U  and  D  have  been  calculated  at  time  just  before  measurements  are  incor¬ 
porated,  the  update  is  performed  on  the  matrices.  MSOFE  performs  a  scalar  update 
for  each  measurement  which  occurs.  The  equations  for  a  scalar  update  are: 


f  =  Ur(<7)Hr(<<)  (2.37) 

Vj  =  j  —  1,2,  ...,n  (2.38) 

a0  *  R  (2.39) 


The  U  and  D  matrices  are  updated  for  k  =  1,2, . . .  ,n  by: 

**  =  <**-1  +  fkVk 

Dkk{t?)  ~  Dkk(t~)ak-i/ak 

bk  *-  vk  (2.40) 

Pk  =  —fk/dk-l 

For  j  =  1,2, . . . ,  (Jfe  —  1),  the  procedure  is  continued  with: 

UA‘t)  =  Uik(t-)  +  iiPk 

b,  <-  bj  +  U(t  —  «—)»>,,  (2.41) 


The  «—  symbol  in  Equations  (2.40)  and  (2.41)  represent  the  technique  in  programs 
in  which  a  variable  can  be  overwritten  with  a  different  value.  The  new  forms  of  U 
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and  D  are  then  multiplied  using  (2.34)  to  form  the  updated  P  matrix.  The  state 
vector  is  subsequently  updated  using  the  following  equations. 

K  (it)  =  b/an  (2.42) 

&(<+)  -  fx(tr+)  +  K(ti)[zi-H(ti)6x(t')]  (2.43) 

This  process  is  repeated  for  as  many  scalar  measurements  as  are  available  at  time 
U.  With  the  completion  of  the  update,  the  state  vector  and  covariance  matrix  can 
be  propagated  to  another  update  time. 

2.6.1  Extended  Kalman  Filter  The  Kalman  filter  equations  shown  above  re¬ 
quire  that  the  dynamics  equations  be  linear.  Ohe  feature  of  linear  equations  is  that 
they  contain  only  elements  which  are  taken  to  the  first  power.  Nonlinear  equations 
contain  squares,  cubes,  or  greater  powers  of  terms  in  the  equation.  An  example  of  a 
linear  equation  is: 

it  =  x\  +  (2.44) 

whereas,  a  nonlinear  equation  may  take  the  following  form: 

x\  -  x]  +  x\  +  x3  (2.45) 

When  some  or  all  of  the  dynamics  equations  are  non-linear,  it  becomes  necessary  to 
either  linearize  the  model  or  utilize  an  extended  Kalman  filter. 

The  linearized  Kalman  filter  takes  some  assumed  or  known  nominal  trajectory 
and  evaluates  the  derivatives  of  the  dynamics  equations  at  the  nominal  trajectory 
to  form  the  dynamics  matrix.  That  is,  with  a  nonlinear  set  of  equations, 

x(<)  =  f[x(t),u(t),t]  (2.46) 
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and  some  nominal  trajectory,  xn(<),  the  linearized  dynamics  matrix  is  found  by 
(17:41): 


F(«;  *.(«)]  = 


Qy.  lx»x„(0  (2.47) 

A  nonlinear  set  of  update  equations  are  linearized  in  a  similar  fashion  (17:41). 


H[<,;xn(t,)]  = 


dh[x,  U] , 

- |X-Xn(«i) 


(2.48) 


The  extended  Kalman  filter  is  basically  a  linearized  Kalman  filter  which  relinearizes 
the  dynamics  equations  after  each  update  (17:42),  and  the  update  matrix,  H  ,  is 
relinearized  after  each  propag^tir  n  (17:44).  An  extended  Kalman  filter  is  used  in 
this  thesis.  The  nonlinear  equations  are  linearized  using  a  Taylor  series  expansion 
and  truncating  to  first  order. 

For  truth  model  validation,  a  covariance  analysis  of  the  linearized  filter  as¬ 
sociated  with  the  extended  Kalman  filter  is  performed  rather  than  a  Monte  Carlo 
analysis  of  the  extended  Kalman  filter.  The  covariance  analysis  is  used  to  decrease 
total  simulation  time  to  validate  the  models.  The  linearization  of  the  extended  filter 
is  used  because  that  is  how  MSOFE  processes  the  filter  in  covariance  mode. 


2.7  Software  Tools 

As  mentioned  above,  PC  Buffer  Box  (11)  is  instrumental  in  obtaining  empirical 
data  from  the  GPSUE.  Three  other  programs  are  also  instrumental  to  the  completion 
of  the  work.  The  programs  are  PROFGEN,  MSOFE,  and  MATRIX*. 

2.7.1  PROFGEN  PROFGEN  is  short  for  PROFile  GENerator.  This  pro¬ 
gram  allows  for  the  generation  of  flight  profiles  designed  by  the  user.  The  user  is 
able  to  specify  the  flight  route  and  maneuvers  to  be  flown,  and  PROFGEN  gen¬ 
erates  position,  attitude,  velocity,  and  acceleration  information  for  the  flight.  The 
data  output  by  PROFGEN  is  usable  by  MSOFE.  More  information  on  PROFGEN  is 
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available  in  ’PROFGEN  -  A  Computer  Program  for  Generating  Flight  Profiles’  (2). 

2.7.2  MSOFE  MSOFE  stands  for  Multimode  Simulation  for  Optimal  Filter 
Evaluation.  This  program  allows  the  user  to  perform  Monte  Carlo  and  covariance 
evaluations  of  Kalman  filters.  The  user  programs  in  the  dynamics  and  update  mod¬ 
els.  By  using  internal  or  external  trajectory  information,  the  program  allows  the 
user  to  test  the  designed  filter  against  a  truth  model.  The  program  can  be  used  to 
validate  a  truth  model,  and  with  small  modifications,  the  user  can  utilize  empirical 
data  for  measurements.  Information  on  the  use  of  MSOFE  is  found  in  the  MSOFE 
user’s  manual  (4). 

2.7.3  MATRIXt  MATRIX,,  from  Integrated  Systems,  Inc.,  is  a  useful  tool 
for  matrix  manipulation,  control  design  and  analysis,  and  plotting.  The  main  use 
to  which  it  is  put  in  this  work  is  plotting.  MSOFE  is  modified  to  store  the  required 
outputs  in  a  MATRIX,  readable  file.  Then,  the  data  is  loaded  into  MATRIX,  and 
plotted. 

2.8  Summary 

This  chapter  introduced  the  reference  frames  used  in  the  3tudy,  and  their  rela¬ 
tionships  to  each  other  through  transformation  matrices.  Also,  a  short  presentation 
of  the  INS/GPS  Integrated  Lab  concept  and  its  develoyjment  is  given.  A  vital  link  to 
real  world  data  is  through  communication  with  the  physical  devices.  The  methods 
in  which  this  was  accomplished  are  presented  as  well.  The  last  part  of  the  chapter 
deals  with  the  software  tools  used.  The  project  could  not  have  been  performed  in  a 
timely  manner  without  the  aid  of  the  software  tools  described. 
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III.  INS  Truth  Model  Design  and  Verification 


Litton  Guidance  and  Control  Systems  developed  a  93-state  error  model  for  the 
LN-93.  This  model  is  applicable  to  the  LN-94  because  it  is  the  same  INS  repackaged 
to  fit  in  the  F-15  Eagle  fighter  aircraft.  The  error  model  and  the  method  used  to 
verify  this  particular  implementation  of  the  model  are  discussed  here. 

3.1  INS  Truth  Model 

The  states  in  the  INS  truth  model  are  interrelated  through  the  system  dynam¬ 
ics.  The  dynamics  matrix,  F  ,  defines  the  relation  between  the  system  states  and 
their  derivatives  through  the  following  equation. 

$x  =  F£x  +  Gw  (3.1) 

where  w  is  “white”  Gaussian  noise. 

3.1.1  States  of  the  Truth  Model  The  state  vector  used  by  Litton  is  parti¬ 
tioned  into  six  subvectors.  These  subvectors  are  designated  Sx\,  8x3, . . . ,  Sxq.  The 
first  subvector,  £xi  ,  contains  13  states  which  are  general  errors  such  as  position, 
velocity,  attitude,  and  vertical  channel  errors.  The  6x3  subvector  contains  16  states 
which  are  the  gyro,  accelerometer,  and  barometer  time-correlated  errors  and  trends, 
and  subvector  Sx 5  consists  of  18  states  related  to  gyro  bias  errors.  The  6x4  sub¬ 
vector  consists  of  22  states  which  are  related  to  the  accelerometer  and  barometer 
bias  errors.  Subvector  6x&  contains  six  states  related  to  the  accelerometer  and  gyro 
initial  thermal  transients,  and  the  Sxq  subvector  consists  of  18  gyro  compliance 
errors.  All  93  errors  are  shown  in  Table  3.1.  The  line  in  column  two  of  Table  3.1 
separates  the  correlated  errors  above  the  line  from  the  trends  below.  A  definition 
for  each  state  can  be  found  in  Appendix  A. 
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Table  3.1.  States  in  the  LN-94  Error  Model 


General 

Errors 

Correlated 
Errors  and 
Ttends 

Gyro 

Bias 

Errors 

Accelerometer 
and  Gyro 
Initial  Thermal 
Transients 

Gyro  Com¬ 
pliance 
Terms 

sex 

K 

k 

v*. 

FXyz 

60y 

K 

by 

** 

Fxyy 

set 

bx 

FXyX 

v,e 

sa. 

54, 

bx. 

Fxxy 

6<t>v 

Vve 

sBx 

Sa. 

by. 

Fxxx 

6<f>, 

Vic 

Sgg 

Sa, 

bx. 

Fxzx 

tv* 

Sgx 

Xi 

sqax 

F i/,x 

SVy 

*9v 

Xa 

SQAy 

FyXX 

svx 

6g* 

X3 

SQA, 

Fyxy 

6h 

6k 

v\ 

fxx 

Fyxz 

ShL 

mmmm 

l/2 

fvv 

Fyxx  ' 

ss3 

v* 

fxx 

Fvxy 

6S< 

Dxxx 

f*v 

Fxxy 

Dyyy 

fxx 

FXXx 

Vw 

Dxxx 

fyx 

Fxxx 

v„ 

SQb* 

fyx 

F 

a  Zyx 

SQby 

fxx 

F 

rxyy 

So>. 

fxy 

F 

1  zyx 

H 

H  2 

t*3 
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Litton  has  supplied  \a  (one  standard  deviation)  values  for  latitude  and  longi¬ 
tude  errors  and  the  following  states:  8<j>x,  6<j>y,  8<j>z,  <$VX,  <5Vy,  <5VZ,  and  8h.  Hence, 
outputs  of  the  1<t  values  of  these  states  are  necessary  to  verify  that  the  model  has 
been  correctly  programmed  into  MSOFE.  The  86{  terms  represent  the  errors  be¬ 
tween  the  computer  frame  and  the  true  frame.  These  two  states  can  be  related  to 
the  latitude  and  longitude  errors  committed  by  the  INS.  The  8<t>{  terms  are  the  terms 
of  the  skew  symmetric  matrix,  described  earlier,  which  relate  the  computer  frame 
orientation  to  the  true  frame.  The  remaining  terms  of  interest  are  the  velocity  error 
components  in  the  true  frame  and  the  altitude  error. 


3.1.2  Truth  Model  Dynamics  Matrix  Litton  has  partitioned  the  dynamics 
matrix,  F,  into  eight  non-zero  submatrices  which  contain  all  the  non-zero  elements 
of  the  dynamics  matrix.  The  dynamics  matrix,  in  terms  of  the  submatrices  is: 


F  = 


Fn 

0 

0 

0 

0 

0 


Fu 
F  22 
0 
0 
0 
0 


F13 

0 

0 

0 

0 

0 


F,4 

0 

0 

0 

0 

0 


Fw 
0 
0 
0 
F  55 
0 


F  is 
0 
0 
0 
0 
0 


(3.2) 


The  elements  of  these  submatrices  are  presented  in  Appendix  C.  The  time-varying 
terms  used  in  the  matrix  elements  are  explained  here. 

Three  different  angular  velocities  which  are  used  in  the  dynamics  matrices  are 
defined  below.  The  first  is  the  earth  rate  in  the  true  frame. 


fi* 

nc/(  2,1) 

fly 

= 

nc/(  2,2) 

fi. 

nc/(2,3) 
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where  Cl  is  the  earth  sidereal  rate,  7.292115x10"®  rad/sec.  The  equation  for  calcu¬ 
lating  the  craft  rate  is: 


“k 

-VJCRY+Clx 

< 

= 

V'Crx  +  Cly 

Cl, 

(3.4) 


The  V*  and  V*  terms  are  the  x  and  y  velocity  components  in  the  true  frame.  Crx 
and  Cry  are  components  of  the  earth  inverse  spheroid  radii  of  curvature  (14:9). 
They  are  calculated  by: 


Crx  =  i[l---/{c;’(2,3)-2C,'1(2,l)}  (3.5) 

a  a 

Cry  =  i[l-^-/{C/,(2,3)-2C,‘1(2,2)}  (3.6) 

a  a 


where  a  is  the  equatorial  radius  of  the  earth,  and  f  is  flattening  of  the  meridional 
ellipse.  The  third  angular  velocity  is  that  of  the  aircraft  body  with  respect  to  the 
inertial  space.  This  is  calculated  by: 


“k 

“k 

“k 

= 

< 

+  cfc 

(3.7) 


where  <p  ,  t?  ,  and  are  the  rates  of  change  of  roll,  pitch,  and  yaw  respectively.  This 
angular  velocity  is  transformed  to  the  body  frame  by: 


where  is  the  matrix  inverse  of  C^. 


(3.8) 
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Specific  force  values  in  the  true  and  body  frames  are  terms  used  in  the  dynamics 
matrix.  The  equation  relating  the  two  specific  force  vectors  is: 

A'  1  A*  ' 

A‘„  =  C‘b  Aj  (3.9) 

.  A'  ]  Aj  _ 

In  certain  elements,  an  A*  term,  the  specific  force  in  the  z  axis  of  the  body  frame 
with  gravity  removed,  is  found.  This  component  is  found  by: 

A*  m  C‘(l,  3 )A*S  +  Cl( 2, 3 )A[  +  C‘(3, 3 )[A\  -  G]  (3.10) 

where 

G  =  ^0[1  -  (2.00996)-  +5.28659x10-3{C'(2,3)}2]  (3.11) 

a 

go  rn  32.08744  ft./sec.2  (3.12) 

The  notation  Cl(i,j)  indicates  the  element  in  row  i,  column  j  of  the  body  to  true 

frame  direction  cosine  matrix. 

All  nine  elements  of  the  body-to-true  direction  cosine  matrix  are  utilized  in 
the  dynamics  matrix.  To  reduce  the  space  required,  the  notation  for  indicating  each 
element  has  been  shortened.  The  element  Cl(i,  j)  is  indicated  in  the  matrix  as  C,j . 

Four  vertical  channel  variables  are  used  in  the  dynamics  matrix.  These  con¬ 
stants  are  used  as  multipliers  of  states  Shi,  SS, j,  and  Shc  in  the  error  model  which 
feedback  to  the  vertical  velocity  and  altitude  error  states.  They  are  calculated  by 
the  following  algorithm  (14). 


A  =  |V?| 


(3.13) 


Ao 


Ai 


k\ 

fcj 

&3 

*4 


/ 


30  fpe 

initud'y 

Ao  +  8 

if  A0<A  , 

A0  —  # 

if  Ao  >  A  and  Ao  >  S3 

30  fps 

otherwise 

100(1  +  ( £-)»] 

_3_ 

Ai 

2go  ,  4 
a  A2 

A? 

A2  * 


Ag  +  A2 


(3.14) 

(3.15) 

(3.16) 

(3.17) 

(3.18) 

(3.19) 


The  ten  correlated  errors  in  6x2  and  the  six  accelerometer  and  gyro  initial  thermal 
transients  are  all  first  order  Markov  processes.  Their  correlation  times  are  presented 
below. 


=  pj  min.-’ 

= 

\  min."1 

=  g5o  sec-_1 

= 

55  sec--1 

Phc 

=  ioo  sec-_1 

— 

-  i.n,  .  Sec  -* 

121522.3 

The  subscripts  on  the  correlation  time  identifiers  refer  to  the  particular  state  to  which 
they  correspond  (see  Appendix  A).  The  bracketed  x,y,  and  z  subscripts  indicate  that 
there  is  a  separate  state  for  each  of  the  three  axes. 


The  velocity  for  ‘he  gravity  error  time  constant  is  calculated  as: 


|V|  =  Jvf+V}  +  V? 

Many  of  the  values  in  the  dynamics  matrix  are  time  varying.  Thus,  the  equations 
presented  are  programmed  into  MSOFE  as  shown  so  that  the  dynamics  matrix  may 
be  time  varying. 
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8.1.8  Model  Dynamics  Driving  Noise  As  indicated  in  Equation  (3.1),  there 
is  some  “white”  Gaussian  noise  driving  the  system.  Litton  partitioned  the  Gw  term 
into  two  groupings.  The  form  of  the  noise  term  is,  using  the  same  partitioning  as 
seen  in  Equation  (3.2): 


wi 

W2 


(3.20) 


It  was  shown  earlier  that  £{w(<)}  =  0  and  E{ w(t)wT(t  +  r)}  =  Q(t)6(r).  To  be 
consistent  with  the  partitioning  of  the  noise  term  into  two  column  matrices,  the  Q 
term  is  also  partitioned  into  two  terms.  The  form  of  the  matrix  used  in  the  model 
is  shown  below. 


Q  = 


Qn  0  0  0  0  0 

0  Q22  0  0  0  0 

0  0  0  0  0  0 

0  0  0  0  0  0 

0  0  0  0  0  0 


(3.21) 


The  elements  of  Qn  and  Q22  are  shown  in  Appendix  D.  The  /?  terms  which  appear 
in  the  matrices  are  the  same  as  those  defined  for  the  dynamics  matrix,  as  seen  on 
the  previous  page.  The  cr  terms  are  displayed  below. 


=  .09°/hr./>/Hz 

^-w.l  =  1(W>/ Hz 

=  .002° /hr. 

=  5  arcsec 

<7skc  —  100  ft. 
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S.2  Truth  Model  Verification 

After  programming  the  model  into  MSOFE,  the  model  is  verified.  During  the 
process  of  verification,  a  number  of  discrepancies  between  the  equations  and  matri¬ 
ces  provided  in  the  Litton  document  were  discovered.  Also,  data  on  calculations  of 
various  data  and  some  values  of  constants  were  discovered.  The  discrepancies  and 
omissions  were  resolved  with  the  help  of  Mr.  Lowell  Knudsen  (13)  and  Dr.  James 
Huddle  (10)  of  Litton  Guidance  and  Control  Systems.  Errata  for  the  truth  model 
document  provided  by  Litton  are  presented  in  Appendix  F.  The  Litton  document 
provided  five  types  of  navigation  simulations  to  form  the  basis  for  comparisons.  The 
ten-hour  static  navigation  with  eight-minute  gyrocompass  alignment  and  a  two-hour 
fighter  navigation  with  eight-minute  gyrocompass  alignment  are  chosen  for  com¬ 
parison.  The  static  navigation  is  chosen  because  of  the  ease  of  implementation  on 
MSOFE,  and  the  fighter  profile  is  chosen  because  it  provides  the  greatest  observabil¬ 
ity  of  the  error  states. 

3.2.1  Gyrocompass  Alignment  The  INS  undergoes  an  eight-minute  gyrocom¬ 
pass  alignment  at  the  beginning  of  each  simulation.  The  values  used  for  A,  h ,  Vc, 
Vv,  A*,  Av,  and  A,  are  0  deg.,  0  ft.,  0  fps,  0  fps,  0  fps,  0  ft. /sec.2,  0  ft. /sec.2,  and 
32.08744  ft. /sec.2  respectively  for  both  flight  profiles.  The  latitude  is  different  for  the 
two  flight  profiles.  For  the  static  navigation,  the  latitude  is  32  deg.  46.6  min.  North, 
and  the  latitude  is  45  deg.  North  for  the  fighter  profile.  Following  the  discussion 
in  Capt  Solomon’s  master’s  thesis  (21:3-9),  the  alignment  is  simulated  by  updating 
the  Horizontal  plane  velocity  errors  at  a  rate  of  1/2  Hz.  The  velocity  updates,  up¬ 
date  rate  and  the  measurement  noise  variances  are  provided  by  Litton  engineers  as 
described  in  Capt  Solomon’s  thesis  (21:3-9). 

MSOFE  requires  that  the  H  matrix  and  measurement  noise  strength  ( R )  values 
for  each  update  be  entered  in  the  program.  MSOFE  performs  the  updates  in  a 
sequential  manner.  If  two  measurements  occur  at  the  same  time,  MSOFE  performs 
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an  update  with  one  measurement  and  then  performs  a  another  update  with  the 
second  measurement.  The  H  matrices  and  measurement  noise  values  used  for  the 
alignment  are  given  below. 

The  values  for  the  update  of  the  V  velocity  error  are: 


H  =  [0  00000100. ..0]  (3.22) 

R  =  0.02  ft.Vsec.2  (3.23) 

The  values  used  for  the  'y'  velocity  error  are: 

H  =  (0  00000010. ..0]  (3.24) 

R  =  0.02  ft.a/sec.3  (3.25) 


The  alignment  simulation  is  run  for  an  alignment  time  of  eight  minutes.  Plots  of 
the  variances  of  latitude  error,  longitude  error,  and  the  states  6<f>x,  6<f>y,  6<ftx,  6VX, 
SVv ,  and  6VX  are  obtained  for  the  covariance  analysis  simulation  and  are  shown  in 
Figure  3.1. 

On  the  plot  of  the  tilt  errors,  the  north  tilt  lies  on  top  of  the  east  tilt  so  that  it 
appears  that  the  east  tilt  error  is  not  displayed.  The  east  tilt  error  is  actually  being 
displayed,  it  is  merely  hidden  by  the  north  tilt  error.  Some  processing  of  the  states 
is  performed  to  obtain  output  of  latitude  and  longitude  errors  in  feet  and  to  obtain 
the  and  6  Vi  terms  in  the  navigation  frame.  Since  a  covariance  analysis  is  being 
performed,  the  processing  is  performed  on  the  covariance  matrix.  The  following 
calculations  are  used  to  obtain  the  latitude  and  longitude  errors  in  feet: 


P  st 


P(  1,1)  P(l,2)  P(l,3) 
P(2,l)  P( 2,2)  P( 2,3) 
P(3,l)  P(3,2)  P{ 3,3) 


(3.26) 

(3.27) 
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S.2.S  Static  Navigation  Simulation  The  static  simulation  is  performed  with 
a  position  of  32  deg.  46.6  min.  North  latitude  and  0  deg.  longitude.  MSOFE 
provides  a  file  at  the  end  of  a  run  which  can  be  used  to  initialize  data  at  the  start  of 
another  run.  The  data  available  at  the  end  of  the  alignment  simulation  for  32  deg. 
46.6  min.  North  latitude  is  used  to  initialize  the  variables  at  the  start  of  the  static 
navigation. 

The  variables  which  are  compared  to  the  available  Litton  information,  shown 
for  this  simulation  and  the  fighter  flight  in  Appendix  F,  are  plotted  in  Figure  3.2. 
These  plots  are  similar  to  the  plots  in  the  Litton  CDRL  indicating  that  the  model 
has  been  correctly  implemented.  The  most  significant  differences  are  the  size  of 
oscillations  of  the  horizontal  velocity  and  tilt  errors.  The  oscillations  are  not  of  the 
same  magnitude,  but  the  same  general  trend  is  evident.  Also,  the  end  magnitudes  are 
smaller  in  the  covariance  simulation  than  in  the  Litton  document.  The  differences 
are  attributed  to  performing  a  covariance  analysis  while  Litton’s  plots  are  the  average 
of  ten  Monte  Carlo  simulations. 

3.2.3  Fighter  Flight  Profile  Simultion  The  fighter  flight  begins  at  a  latitude 
of  45  deg.  North.  Thus,  the  initial  values  of  the  states  and  covariance  matrix 
are  obtained  from  the  output  at  the  end  of  the  45  deg.  North  latitude  alignment 
simulation. 

The  fighter  flight  is  approximated  as  closely  as  possible  with  the  information 
given  using  PROFGEN.  The  resulting  flight  is  shown  in  Figure  3.3.  The  major 
difference  between  this  flight  and  the  Litton  profile  is  that  the  return  flight  passes 
the  takeoff  point  so  an  abrupt  turnaround  is  performed  to  complete  the  flight  as  close 
to  the  takeoff  point  as  possible.  The  information  shown  in  the  Litton  document  does 
not  show  the  return  flight  passing  the  airfield.  However,  following  the  information 
about  times,  velocities,  and  altittudes  provided,  it  is  impossible  to  keep  from  passing 
the  point  of  takeoff.  The  states  of  interest  are  plotted  in  Figure  3.4.  These  results  are 
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also  similar  to  the  plots  provided  by  Litton  in  Appenix  F.  The  plots  show  the  same 
trends,  and  the  horizontal  velocity  and  tilt  errors  are  nearly  the  same  magnitudes 
as  the  values  shown  in  the  Litton  truth  model  document.  This  provides  additional 
validation  of  this  implementation  of  the  truth  model.  Differences  are  primarily  the 
result  of  using  covariance  analysis  instead  of  Monte  Carlo  simulations  as  stated 
earlier.  Errors  at  the  end  of  the  flight  are  the  result  of  the  differences  in  the  flight 
profiles  at  this  point. 

3.3  Summary 

The  truth  model  as  given  in  the  Litton  CDRL  is  programmed  into  MSOFE. 
Simulations  are  performed  for  an  eight-minute  alignment,  a  ten-hour  static  naviga¬ 
tion,  and  a  two-hour  fighter  flight.  A  small  amount  of  post  processing  is  necessary  to 
transform  the  data  into  the  reference  system  used  by  Litton.  Plots  of  state  variables 
are  compared  for  the  static  navigation  and  fighter  flight  simulations.  The  plots  are 
similar  in  nature.  Differences  are  the  result  of  different  types  of  simulations  being 
performed.  Overall,  the  simulations  are  quite  similar,  and  the  model  is  judged  to  be 
correctly  implemented. 
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IV.  GPS  Truth  Model  Design,  Validation  and  Integration  with  INS 


The  truth  model  used  for  the  Global  Positioning  System  is  based  on  a  model 
developed  by  Capt  Solomon  (20).  The  truth  model  contains  22  states.  Twenty  states 
are  five  states  repeated  four  times,  once  for  each  satellite  being  used  to  calculate  the 
navigation  solution.  The  remaining  states  pertain  to  the  user  clock  errors. 

4-1  GPS  Truth  Model  States 

The  GPS  truth  model  contains  states  for  the  user  clock  error,  code  loop  error, 
atmospheric  error,  and  satellite  position  error.  A  brief  discussion  of  each  error  is 
given  here.  The  code  loop  error,  atmospheric  error,  and  satellite  position  errors  are 
repeated  four  times,  once  for  each  satellite.  User  clock  errors  are  the  predominant 
errors  in  the  pseudorange  and  delta-range  measurements.  Thus,  it  would  seem  that 
more  states  should  be  used  to  model  the  user  clock  errors  than  the  errors  due  to 
the  satellites.  However,  the  user  clock  errors  are  predominantly  a  bias  and  a  drift. 
Hence,  only  two  states  are  used  to  model  this  error.  However,  the  satellite  errors 
are  large  enough  to  affect  the  measurements,  and  the  satellite  position  errors  are 
not  easily  classified  into  one  or  two  states.  Hence,  five  states  are  used  to  model  the 
satellite  errors. 

4.1-1  User  Clock  Error  Two  states  are  used  to  model  the  user  clock  error. 
These  states  model  the  clock  error  as  a  bias  and  a  drift.  This  model  is  implemented 
with  the  following  equations. 


Sxb 

0 

1 

<5x4 

Sxd 

0 

0 

Sxd 
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The  initial  conditions  used  for  these  errors  are: 

6x(to)  =  0 

9xl014  ft.2  0 
0  9xl010  fps2 

No  driving  noise  is  included  in  this  model.  This  could  cause  the  Kalman  filter  gains 
to  go  to  zero  if  the  same  model  were  used  without  change  as  part  of  the  filter  design 
model.  Hence,  it  might  be  necessary  to  include  some  pseudonoise  in  the  filter  to 
prevent  this  occurrence. 

4- 1.2  Atmospheric  Error  The  atmospheric  error  is  modeled  as  a  first  order 
Markov  process  with  a  correlation  time  of  500  seconds  (20:7).  This  model  takes  into 
consideration  not  only  atmospheric  delay,  but  it  also  includes  ionospheric  delays 
which  have  not  been  totally  removed  by  the  receiver  prior  to  updating  with  the 
pseudorange  and  delta-range  measurements.  The  equations  used  for  this  model  are 
shown  below. 

$Xa tm{t)  ~  gQQ tm{t)  d"  ^atm  (4.2) 

£{uw(*)}  =  0 

ft 2 

E{watm(t)watm(t  +  r)}  =  0.004  — ~  <5(r) 

sec. 

The  initial  conditions  for  this  model  are: 

=  0 

Patm(to)  =  1ft-2 

The  correlation  time  and  initial  covariance  values  used  by  Capt  Solomon  are  based 
on  an  aircraft  flight  at  an  average  of  30,000  feet.  The  laboratory  is  stationary  at 
approximately  1000  feet;  therefore,  it  may  be  necessary  to  decrease  these  values  for 
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filter  implementation  with  empirical  data  because  there  is  more  atmosphere  between 
the  receiver  and  the  satellites.  Thus,  the  atmospheric  errors  may  change  at  a  greater 
rate  than  is  being  modeled.  The  values  of  Q  =  0.004  ft.2/sec.  and  Pa<m(*o)  =  1  ft.2 
yield  stationary  process  characteristics. 

Atmospheric  delay  is  not  only  a  function  of  time  but  is  also  a  function  of 
portion  of  the  sky  in  which  the  satellite  is  located.  The  signal  from  a  satellite  behind 
a  cloud  will  be  delayed  a  different  amount  than  the  signal  from  a  satellite  with  clear 
sky  between  it  and  the  GPS  antenna.  Thus,  separate  atmospheric  states  are  used 
for  each  satellite  because  different  satellites  may  be  in  different  portions  of  the  sky. 

4.1.3  Code  Loop  Error  The  phase  lock  loop  in  the  GPSUE  has  a  bandwidth 
of  approximately  1  radian  per  second  to  maintain  signal  lock  even  in  a  jamming 
environment.  Therefore,  this  error  is  also  modeled  with  a  first  order  Markov  process 
shaping  filter.  The  equations  for  implementing  this  model  are: 

^®c<w<e(0  =  —  "b  code  (4.3) 

£{«We(*)}  =  0 

ft.2 

E{wcode(t)wcode(t  +  r)}  =  0.5  — —£(t) 

sec. 

with  initial  conditions: 

^•Ecofte(^o)  =  0 

Pcodeito)  =  0.25  ft.2 

The  correlation  time  of  this  model  is  one  second.  The  correlation  time  and  the  initial 
covariance  of  0.25  ft.2  determines  the  noise  strength  of  0.5ft.2/sec  in  order  to  yield 
stationary  process  characteristics. 

The  five  channel  receiver  in  use  in  this  research  utilizes  a  separate  correlator 
board  for  each  satellite  being  used.  Hence,  a  separate  code  loop  is  being  used  for 
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each  satellite.  Thus,  a  separate  code  loop  error  is  modeled  for  each  satellite. 

4.1.4  Satellite  Position  Error  The  satellite  position  error  is  modeled  as  a 
three-dimensional  random  bias  vector.  Each  state  models  one  component  of  the 
satellite’s  position  error  in  the  ECEF  frame.  Some  pseudonoise  may  be  necessary 
to  portray  the  time  varying  nature  of  this  error  accurately.  The  equation  used  to 
model  this  error  is: 

=  0  (4.4) 

with  initial  conditions: 

fixp0t(t  0)  ==  0 

25  0  0 

P pot  (to)  =  0  25  0 

0  0  25 

4.2  GPS  Truth  Model  Equations 

The  equations  for  the  GPS  error  models  are  programmed  into  MSOFE.  The 
forms  of  the  dynamics  and  process  noise  matrices  are  presented  here. 

4-2.1  GPS  Dynamics  Matrix  The  dynamics  matrix  for  the  GPS  model  is 
taken  directly  from  the  equations  for  the  error  states.  The  dynamics  matrix  is 
shown  below: 

Fcik  0  0  0  0 

0  FJVj  0  0  0 

F  gps  =00  F,Iua  0  0 

0  0  0  F,VJ  0 

0  0  0  0  FfV4 
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where 


F  elk 


0  1 
0  0 


FJt/j  — 


556  0  0  0  0 

0  -1000 
0  0  0  0  0 

0  0  0  0  0 

0  0  0  0  0 


4-2.2  GPS  Process  Noise  Matrix  The  process  noise  matrix  Q  is  broken  into 
four  parts.  The  form  of  this  matrix  is: 


Q  GPS  = 


0  0  0  0  0  0 

000  0  0  0 

0  0  QJVl  0  0  0 

0  0  0  QiVa  0  0 

000  0  q,„3  0 

000  0  0  q,„4 


(4.6) 


where 


Q/t 


0.004  0  0  0  0 

0  0.5  0  0  0 

0  0  0  0  0 

0  0  0  0  0 

0  0  0  0  0 


ft^ 

sec. 
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4.8  GPS  Truth  Model  Verification 

A  one-hour  filter  run  is  performed  to  determine  whether  or  not  the  equations 
axe  entered  correctly.  The  diagonal  terms  of  the  covariance  matrix  are  examined  to 
determine  if  the  states  are  behaving  as  expected. 

The  user  clock  drift  and  satellite  position  error  variances  should  remain  con¬ 
stant,  and  the  user  clock  bias  should  be  a  line  with  slope  equal  to  the  clock  drift. 
The  code  loop  and  atmospheric  delays  are  first  order  Markov  processes.  With  the 
initial  variances  presented  earlier,  the  variances  for  these  two  states  should  be  con¬ 
stant.  However,  in  order  to  display  the  transient  which  occurs  with  different  initial 
variances,  the  initial  variances  for  the  atmospheric  and  code  loop  delay  states  are 
switched.  Hence,  their  variances  should  approach  their  final  values  within  their  re¬ 
spective  correlation  times  and  remain  constant  thereafter.  The  plots  for  the  one  hour 
simulation  of  the  GPS  model  are  shown  in  Figure  4.1.  The  models  of  atmospheric 
and  code  loop  delays  and  satellite  position  errors  are  the  same  for  all  four  satellites, 
and  this  results  in  identical  variances  during  the  analysis.  Hence,  the  results  for 
just  one  satellite  are  shown.  While  the  models  for  the  satellite  states  are  the  same 
for  each  satellite,  the  actual  values  of  the  errors  in  the  “real”  world  are  different 
for  different  satellites.  Thus,  the  separation  of  the  five  satellite  specific  errors  is 
retained.  The  user  clock  errors  display  the  expected  results  as  do  the  atmospheric 
delay  and  satellite  position  errors.  The  code  loop  delay  appears  to  be  just  a  straight 
line;  however,  the  code  loop  correlation  time  is  one  second.  Thus,  the  code  loop 
delay  reached  its  final  value  before  the  first  sample  was  taken  at  ten  seconds  into  the 
run.  Therefore,  the  models  are  determined  to  be  programmed  correctly. 

4-4  GPS  Integration  vrith  INS 

With  the  INS  model  verified  against  a  known  standard  and  the  GPS  model 
determined  to  be  correctly  programmed,  the  models  are  combined  into  a  single  truth 
model,  and  they  are  programmed  as  a  single  Kalman  filter.  The  full-ordered  filter  is 
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to  be  used  as  a  baseline  for  order  reduction  in  laboratory  experiments;  so,  no  order 
reduction  is  performed  at  this  point.  Hence,  the  full-ordered  filter  is  being  simulated. 

4-4-1  True  vs  Filter  Trajectory  Information  The  trajectory  information  for 
the  verification  of  the  models  is  uncorrupted  by  errors  (“true”  trajectory  data). 
This  information  is  either  programmed  directly  into  MSOFE,  static  navigation  case, 
or  provided  by  PROFGEN,  fighter  flight  profile  case.  For  the  filter  performance  pre¬ 
diction,  the  truth  model  dynamics  matrix  is  calculated  with  the  “true”  trajectory 
data.  However,  the  filter  is  provided  corrupted  trajectory  information.  The  truth 
model  calculations  of  the  INS  errors  are  subtracted  from  the  “true”  trajectory  to 
obtain  information  similar  to  that  provided  by  an  actual  INS,  and  the  filter  esti¬ 
mation  of  the  errors  are  added  to  the  information  to  obtain  the  filter’s  estimate  of 
the  trajectory  data.  The  calculations  to  provide  the  filter  trajectory  data  are  shown 
below.  The  wander  angle  is  corrupted  by: 


QUn.  =  at~  Sat 


where 


6at  =  89x  —  £Asin$ 


The  Kalman  filter  estimate  of  the  corrupted  wander  angle  is: 


where 


=  aun,  +  8at 


A  A  A 

Sat  =  89,  —  6Asin$ 


(4.7) 


(4.8) 


(4.G) 


(4.10) 
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The  estimate  of  the  position  vector,  ft,  is  determined  by: 


where 


ft  = 


$lru«  -  69  +  69 

A 

~~  6  \  ^  \ 

A 

hfrue  ""  SH  4"  6h 


69  **  66y  sin  at  —  66t  cos  at 

A  A  A 

69  as  66v  sin  q<  —  69x  cos  at 
6 A  =  (60v  cos  at  +  66 x  sin  at )  sec  $ 

A  A  A  A 

6X  *  ( 66y  cos  at  -f  69 x  sin  at )  sec  $ 
6h  m  Sh 
6h  =  6h 


(4.11) 


(4.12) 

(4.13) 

(4.14) 

(4.15) 

(4.16) 

(4.17) 


The  velocity  vector  is  also  used  in  the  dynamics  matrix.  The  equation  used  for 
calculating  the  velocity  vector  follows: 


Kr,r„.  -  sv.  +  6Vg 
Vytru.  ~  6Vy  +  6Vy 
V,tru.  -  6VX  +  6VX 


(4.18) 


AAA 

where  6VX,  6 Vy,  and  6VX  are  filter  states.  Since  specific  force  errors  are  not  a  part  of 
the  model,  the  specific  force  vector  utilized  in  the  filter  is  obtained  from  the  “true” 
trajectory  data. 

4-4-2  GPS  Measurement  Equations  Two  types  of  measurements  are  used  to 
update  the  filter.  These  are  pseudorange  and  delta-range  information  from  the 
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(4.19) 


t 


GPSUE.  The  form  of  the  filter  calculated  pseudorange  (i?e)  equation  is  (20); 

Re  =  %/(*„  -  &)>  +  (fc„  -  Y,i7  +  (Z„  -  Z,)J 
+$Rctk  +  SRatm  +  6R<U 
=  A  +  (4.20) 


The  model  for  the  measured  pseudorange  (i?m)  is: 

Rm  =  y/(xlv  -  xry  +  (y,v  -  Yry  +  (z.„  -  zry  +  6Rcth  +  8Ratm  +  srcI  +  v  (4.21 ) 


where  v  is  the  measurement  noise,  and: 


£[»(«<)]  =  0 
E[v(U)2]  =  1026  ft.2 
£?[v(t,)v(<i)]  =  0  i  ^  j 

The  value  of  the  measurement  noise  strength  is  taken  from  Martin’s  paper  on 
GPSUE  error  models  (15:118).  The  pseudorange  calculation  provides  a  measure¬ 
ment  equation  of  the  form: 

z  —  h(x,t)  +  v  (4.22) 

The  update  equation  requires  that  h(x,  t)  be  linearized  about  the  current  best  esti¬ 
mate  of  the  states.  Expanding  the  pseudorange  calculation  in  a  Taylor  series  and 
truncating  to  first  order  yields: 


Rc  =  Rt  + 


Xtv  —  XT  c  ,  Y,v  —  Yr  .  Zsv  ~  Zr 


Rt 


•8XSV  -I- 


Rt 


■SYtv  + 


Xtv  —  Xr  c  i,  Ytv  —  Yr  Zsv  —  Zr 


-6Xr- 


Rt  Rt 

+SRctk  +  fiRatm  +  GRcl 


-6Yr- 


Rt 


Rt 

8Zr 


8Z, 


(4.23) 
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(4-24) 


=  At  +  ULOSxSX,v  +  UL0Sy6Y,v  +  UL0S,6Ztv 
-ULdSJXr  -  UCdSy6Yr  -  UL0St6Zr 
+6Rclk  +  6*Ratm  +  6Rcl 

The  position  errors  for  the  receiver,  which  are  ?haied  with  the  INS  model,  are  in  the 
true  frame,  and  the  measured  pseudorange  is  in  the  ECEF  frame.  Therefore,  the 
position  errors  must  be  transformed  to  the  ECEF  frame  for  the  calculation  of  the 
estimated  pseudorange.  The  transformation  takes  the  following  form: 

Yr  -(Re  +  h)60x 

Xr  =c*t  (RB  +  h)66y  (4.25) 

Zr  6h 

where  (Re  +  h)  is  the  local  distance  to  the  center  of  the  earth  at  the  current  position. 
Note  that  Xr  and  Yr  appear  to  be  interchanged.  This  accounts  for  the  position  error 
states’  rotations  about  the  axis  rather  than  distances.  The  multiplication  by  (Re  +  h) 
translates  the  rotations  into  distances.  This  yields  an  H  array,  for  satellite  number 
one,  of  the  form: 

H  =  [  -  ULOSj  -  ULOSy  -  U LOS,  0  •  •  •  0 

10  11  (4.26) 

ULOSx  ULOSy  ULOS,'  0  •  •  •  0  ] 

The  other  three  satellite  updates  would  differ  from  (4.26)  in  the  placement  of  the 
last  two  non-zero  terms  on  the  second  row  and  three  non-zero  terms  in  the  last  row 
of  the  equation  (composed  of  twelve  terms  in  all).  The  elements  shown  as  U LOS,1 
are  meant  to  include  all  transformations  which  take  the  INS  position  errors  in  the 
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true  frame  to  the  proper  dimensions  in  the  ECEF  frame. 

The  delta-range  (DR)  is  a  measure  of  the  range  rate  over  the  past  time  interval. 
The  delta-range  is  measured  by  counting  the  carrier  cycles  over  a  period  of  time 
(15:110).  Thus,  the  delta-range  is  the  change  in  pseudorange  over  a  particular  time 
interval  rather  than  the  rate  of  change  of  pseudorange.  The  range  rate  equation  is 
derived  by  differentiating  the  true  range  (Rt)  equation.  This  results  the  equation: 


(X„  -  X,)(Vx„  -  Vx,)  (V„  -  Yr)(Vy„  -  Vy,) 

R  '  Ji 

(Zav  -  Zr)\vz„  -  VZr) 

Ri 


(4.27) 

(4.28) 


This  derivation  assumes  the  laboratory  is  not  experiencing  roll  rates  or  high  g  ma¬ 
neuvers.  Thus,  for  this  specific  case,  the  model  for  the  measured  delta-range  is 
approximated  by  the  range  rate  equation: 


DR  «  Rm 

M  (■ x„-xr)(yXn-Vxr )  (rw  -  K)(W..  -  Vvr) 

Rm  Rm 

(Z,v-Zr){Vz,v--Vzr) 

Rm 


+  SRclk  +  V 


(  4 


.29) 


(4.30) 


where 


£[u(<,-)]  =  0 
£[v(f,)2|  =  0.16  ft.2 
E[v{U)v(tj)]  =  0  i^j 

and  SRcik  is  the  user  clock  drift  (the  derivative  of  the  user  clock  bias).  Again, 
the  measurement  noise  is  obtained  from  Martin’s  paper  (15:118).  The  equation 
for  filter  calculation  of  the  delta-range  is  similar  to  that  of  the  measured  delta- 
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A 

range.  Substituting  Re  for  Rm  and  using  the  Alter  estimates  of  the  other  values  in 
Equation  4.30  yields  the  filter  calculated  delta-range. 

Expanding  Re  in  a  Taylor  series,  and  truncating  to  first  order  yields: 

kc  =  At  +  T  ^T[I  -  ULOSTULOS](SxJt,  -  Sxr)  (4.31) 
Rt 

+ULOS(6v,u  —  6vr)  +  6*Rcik 

The  transformation  necessary  for  the  pseudorange  is  also  used  here  to  transform  the 
position  errors  into  the  proper  dimensions.  A  transformation  of  the  velocity  errors  to 
the  ECEF  frame  is  also  needed.  For  the  velocity  errors,  the  direction  cosine  matrix 
to  transform  vectors  in  the  true  frame  to  the  ECEF  frame  can  be  used  directly.  The 
elements  of  the  update  matrix  H  are  not  shown  directly  here;  however,  they  can  be 
determined  from  Equation  (4.32). 

To  provide  stability  to  the  stand  alone  INS  solution  it  is  necessary  to  provide 
barometric  altitude  measurement  updates  to  the  filter.  The  form  for  the  calculated 
altitude  follows: 

hc  =  huts  *f  (4.32) 

The  measured  altitude  is  computed  as  the  altitude  of  the  navigation  laboratory 
(approximately  964  feet).  The  form  for  the  measured  altitude  is: 

=  h actual  4"  V  (4.33) 

where 

£(«(<,)]  =  0 
E[v(ti)2]  =  0.0001  ft.3 
£[«(*,>(*;)]  =  0  i^j 
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This  measurement  noise  may  not  be  correct  for  an  actual  altimeter,  but  it  is  indica¬ 
tive  of  the  accuracy  of  the  laboratory  altitude  measurement.  The  H  matrix  for  this 
update  consists  of  zeros  except  for  the  element  associated  with  state  Xi0,  6h. 

4-4-3  Integrated  GPS/INS  Simulation  The  truth  model  is  programmed  into 
the  system  portion  of  MSOFE,  and  the  dynamics  noise  is  programmed  to  be  injected 
into  the  proper  system  states.  Also,  the  update  equations  are  programmed  into  the 
system  and  filter  parts  of  MSOFE.  With  this  accomplished,  a  simulation  is  performed 
to  predict  the  filter  performance. 

The  simulation  consists  of  an  eight-minute  alignment  followed  by  thirty  minutes 
of  static  navigation.  The  filter  is  updated  every  ten  seconds  by  both  pseu  Jorange  and 
delta-range  measurements  during  static  navigation,  and  the  altitude  measurements 
are  incorporated  every  two  seconds  throughout  the  simulation.  Plots,,  ire  obtained 
for  the  measurement,  residuals,  the  position  and  velocity  estimation  errors,  and  the 
satellite  state  estimation  errors  and  are  presented  in  Figures  4.2-4. 7.  All  channels 
exhibit  the  same  behavior  characteristics;  hence,  the  satellite  state  estimation  errors 
are  shown  for  one  channel.  The  user  clock  state  estimation  errors  are  not  presented 
because  they  start  out  with  large  magnitudes,  quickly  drop  to  zero  and  stay  nearly 
zero.  In  the  residual  plots,  the  solid  lines  are  the  residuals,  and  the  dashed  lines  are 
the  filter  calculated  l<r  values  for  the  residual.  In  the  estimation  error  plots,  the  solid 
lines  are  the  error,  and  the  dashed  lines  are  the  estimated  ler  bounds  on  the  error. 
The  estimation  errors  are  the  difference  between  the  “true”  system  values  and  the 
values  for  those  quantities  as  estimated  by  the  filter. 

The  pseudorange  residuals,  shown  in  Figure  4.2,  are  approximately  zero  mean 
and  stay  within  a  reasonable  multiple  of  the  calculated  1<t  value.  Residual  monitoring 
was  utilized  with  a  bound  of  10<7,  and  no  measurements  were  discarded.  The  plots 
display  a  quantization  of  the  residuals,  in  that  ail  residuals  are  multiples  of  four 
(e.g.  4,  8,  -32).  This  is  attributable  to  two  phenomena:  single  precision  variables 
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Figure  4.2.  Pseudorange  Residuals 

being  used  for  measurements  and  residuals  being  the  difference  of  small  numbers. 
The  measurement  values  for  pseudoranges  are  sufficiently  large  that,  with  single 
precision  variables,  the  precision  i3  increased  to  the  units  magnitude.  Thus,  the  least 
residual  is  expected  to  have  a  value  of  one.  With  the  way  data  is  stored  in  a  digital 
computer,  as  binary  numbers,  the  accuracy  of  the  single  precision  variables  may 
actually  be  decreased  to  the  point  where  the  least  significant  bit  actually  represents 
a  magnitude  of  four.  This  accounts  for  the  residuals  appearing  quantized  as  multiples 
of  four.  The  decision  is  made  to  continue  in  single  precision  because  this  does  not 
appear  to  be  affecting  the  simulation  in  a  negative  way. 

Delta-range  residuals  are  presented  in  Figure  4.3.  The  residuals  appear  to  be 
nearly  zero-mean  although  some  plots  tend  to  be  slightly  biased.  They  also  remain 
within  the  10<r  bound  for  residual  monitoring.  However,  the  delta-range  calculations 
appear  to  be  less  accurate  than  originally  anticipated;  so,  the  measurement  noise  is 
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Figure  4.4.  User  Position  Estimation  Errors 
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Figure  4.7.  Atmospheric  and  Satellite  Position  Estimation  Errors 
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increased  to  0.5  ft.2  for  the  delta-range  update.  The  slight  bias  being  shown  in  two 
of  the  plots  is  likely  due  to  having  performed  only  one  Monte  Carlo  simulation.  The 
biases  should  disappear  with  more  simulations  averaged  and  should  be  investigated 
later. 

Figure  4.4  presents  the  user  position  estimation  errors.  The  longitude  error 
remains  within  60  feet  of  zero  and  shows  no  particular  bias  over  the  whole  time 
period.  The  latitude  error  takes  approximately  ten  minutes  before  settling  about 
zero  error.  The  altitude  error  oscillates  rapidly  about  zero  as  the  result  of  the 
high  accuracy  altitude  updates.  The  error  being  displayed  is  basically  reflecting  the 
residuals  from  the  altitude  updates.  Some  slight  biases  over  small  time  intervals  may 
be  noted  in  both  the  latitude  and  longitude  plots.  These  are  again  decided  to  be 
the  result  of  having  performed  only  one  simulation.  More  simulation  runs  should  be 
averaged  to  determine  the  correctness  of  this  statement. 

The  horizontal  velocity  errors,  shown  in  Figure  4.5,  exhibit  a  distinct  bias. 
The  vertical  velocity  error  is  zero-mean,  and  again  it  reflects  the  high  accuracy  used 
for  the  altitude  updates.  The  biases  shown  ;n  the  horizontal  velocities  could  be  the 
result  of  having  run  only  one  simulation,  it  could  show  something  wrong  with  the 
delta-range  updates,  or  it  could  show  the  effect  of  the  high  accuracy  altitude  updates 
pushing  vertical  errors  into  the  horizontal  plane.  These  are  areas  for  further  study. 
At  this  point,  the  errors  are  within  expected  values  for  the  velocity  errors  and  the 
decision  is  made  to  continue. 

The  code  loop  delay  is  plotted  with  two  separate  plots  because  of  the  disparity 
in  size.  The  system  delay  is  behaving  as  a  first  order  Markov  process  with  a  one 
second  time  constant  is  expected  to  behave.  However,  the  filter  does  a  very  poor 
job  of  estimating  the  code  loop  delay.  This  indicates  a  couple  of  possibilities:  the 
state  is  almost  unobservable,  the  driving  noise  is  too  small,  or  the  update  rate  is 
insufficient  for  the  filter  to  get  a  good  estimate  of  this  error.  Since  the  driving  noise 
is  the  same  for  the  system  and  filter,  the  second  possibility  is  not  considered.  The 
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other  two  possibilities  are  areas  for  further  study.  The  decision  is  made  to  continue 
as  the  error  contributed  by  the  code  loop  is  not  so  large  that  compensation  can  not 
be  provided  in  other  states. 

The  remaining  four  states  are  shown  in  Figure  4.7.  The  atmospheric  error 
displays  a  slight  bias.  This  could  be  the  result  of  the  poor  code  loop  delay  estimation 
or  of  having  performed  only  one  simulation.  The  satellite  position  errors  display 
biases  in  the  Xi  and  Zi  directions.  A  bias  may  be  found  in  any  of  the  three  position 
errors  for  each  channel.  This  is  attributable  to  using  stationary  satellites  during  static 
navigation.  Sufficient  observability  of  the  satellite  position  errors  is  not  available 
when  utilizing  one  degree  of  freedom  (i.e.,  line-of-sight  vector  to  satellite  is  constant). 
With  these  small  errors,  the  decision  is  made  to  proceed  to  using  empirical  data. 

4-5  Summary 

The  GPSUE  error  model  is  presented  and  validated.  All  states  behave  as 
expected.  The  GPS  model  is  combined  with  the  INS  model,  and  pseudorange,  delta- 
range,  and  altitude  updates  are  derived.  A  single  Monte  Carlo  run  is  performed  and 
the  results  are  analyzed.  Some  small  errors  are  noted.  Most  of  these  are  attributed 
to  having  performed  a  single-sample  Monte  Carlo  simulation.  Some  minor  biases 
are  observed  but  are  deemed  small  enough  to  justify  implementing  the  filter  with 
empirical  data. 
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V.  Kalman  Filter  Performance  with  Empirical  Data 


Data  collection  and  interpretation  as  well  as  MSOFE  modifications  are  nec¬ 
essary  to  analyze  the  performance  of  the  Kalman  filter  with  empirical  data.  The 
LN-94  is  allowed  to  align  for  eight  minutes  before  switching  to  navigation  mode  and 
collecting  the  data.  Following  the  INS  alignment,  data  is  collected  from  both  the 
GPSUE  and  the  LN-94. 

5. 1  Obtaining  and  Interpreting  Data 

The  data  collection  and  interpretation  requires  many  steps  and  the  use  of  two 
computer  systems,  an  IBM  PC- AT  and  a  Sun  3  Workstation.  The  personal  computer 
is  used  to  collect  data  from  the  GPS  receiver  through  the  instrumentation  port,  and 
the  workstation  is  used  to  obtain  INS  information  on  the  MIL-STD-1553  bus. 

5.1.1  GPS  Data  Collection  Data  is  collected  from  GPSUE  through  the  in¬ 
strumentation  port  using  PC  Buffer  Box  software  on  an  IBM  PC-AT.  PC  Buffer 
Box  consists  of  two  pieces  of  software,  the  data  collection  software  (BB.EXE)  and 
the  post  processing  software  (PP.EXE).  Information  on  this  software  is  found  in  the 
PC  Buffer  Box  User  Manual  (11).  BB.EXE  is  menu  driven  and  very  user  friendly. 
Proceeding  through  the  menu,  a  Phase  III  receiver  3A  is  chosen  for  the  receiver 
type.  Using  ICD-GPS-215  (3),  the  decision  is  made  to  request  block  1022  to  obtain 
the  pseudorange  and  delta-range  information  and  blocks  1026  and  1027  for  satellite 
position  information.  The  data  collection  is  set  to  occur  for  twenty  minutes,  the  file 
to  store  the  data  is  given  a  name,  and  the  data  collection  is  started. 

In  order  for  the  post  processor  to  interpret  the  data  correctly,  a  block  definition 
file  is  programmed  and  given  the  name  BXXXXX.BDF,  where  XXXXX  is  a  five¬ 
digit  number  corresponding  to  the  block  being  processed.  The  block  definition  file 
for  block  1022  (named  B01022.BDF)  is  shown  in  Appendix  E.  The  first  column  is 
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the  name  given  to  each  piece  of  data  in  the  block.  The  second  column  is  the  block 
number;  it  is  always  1022  for  this  block.  The  third  column  is  the  word  count  within 
the  block  at  which  the  corresponding  data  starts.  The  word  length  of  the  data  is 
in  column  four,  and  column  five  indicates  the  data  type:  R  for  floating  point,  I  for 
integer,  and  CF  for  Collins  CAPS  floating  point. 

Following  the  data  collection  and  block  definition  file  setup,  PP.EXE  is  exe¬ 
cuted  to  interpret  the  information.  Selecting  printer  listings  and  block  1022  using 
the  menus,  the  GPS  time,  satellite  numbers,  measurement  type,  and  measurement 
value  are  printed  to  a  file  for  each  channel.  The  four  files  thus  obtained  are  trans¬ 
ported  to  the  Sun  3  Workstation,  and  MSOFE  is  edited  to  read  in  the  information 
for  the  performance  of  measurement  updates. 

A  similar  exercise  is  repeated  to  transport  the  satellite  position  information  to 
the  Sun  3  Workstation  and  edit  MSOFE  to  read  the  four  files  containing  the  satellite 
positions.  These  files  actually  contain  the  line-of-sight  vectors  to  the  satellites  being 
utilized.  Thus,  a  fifth  file  is  generated  to  obtain  the  user  position.  MSOFE  is 
modified  to  read  this  file  and  add  the  user  position  vector  at  each  time  to  the  satellite 
line-of-sight  vectors  to  obtain  satellite  positions.  Also,  MSOFE  is  modified  to  ignore 
any  data  which  is  not  indicated  to  be  a  pseudorange  or  delta- range  measurement. 
This  indication  is  provided  in  block  1022  and  is  included  in  the  files  containing  the 
measurements.  The  main  reasons  for  this  are  that  the  receiver  does  not  provide  a 
pseudorange  and  delta-range  update  for  a  channel  at  any  particular  time  when  either 
fewer  than  four  satellites  are  visible  or  the  channel  is  changing  to  receive  information 
from  a  different  satellite. 

5.1. 2  INS  Data  Collection  Position,  velocity,  accelerati  on,  wander  angle, 
body  attitude,  and  attitude  rates  are  necessary  to  calculate  the  dynamics  matrix 
of  the  filter.  The  data  is  obtained  from  the  LN-94  through  the  MIL-STD  1553 
bus  utilizing  the  Sun  3  Workstation.  The  BCU/VME-1014  MIL-STD-1553  commu- 
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nications  card  made  by  SCI  Technology,  Incorporated  was  installed  on  the  Sun  3 
Workstation  by  Mr.  Bruce  Clay  of  Systems  Research  Laboratory  (SRL).  Informa¬ 
tion  on  the  software  necessary  to  do  this  is  found  in  the  BCU-VME-1014  Operations 
Manual  (19).  The  software  written  by  Mr.  Clay  allows  the  workstation  to  act  as  a 
bus  controller.  In  the  bus  controller  mode,  the  communications  card  collects  all  data 
output  on  the  bus  in  response  to  commands  sent  by  it. 

To  collect  the  data  it  is  necessary  to  know  the  remote  terminal  number  of  the 
device,  the  subaddress  numbers  which  contain  the  required  data,  and  the  number 
of  thirty-two  bit  words  in  each  subaddress.  The  LN-94  ic  hard-wired  to  be  remote 
terminal  number  five.  Utilizing  FNU-85-1  (1),  the  decision  is  made  to  request  sub¬ 
address  numbers  one  and  sixteen.  Altitude  information  is  supplied  to  the  INS  using 
subaddress  four.  Subaddress  one  is  twenty-two  words  long,  subaddress  four  is  two 
words  in  length,  and  the  wordlength  of  subaddress  sixteen  is  thirty- two  (1:257,260- 
262).  The  execution  blocks  are  programmed  as  specified  in  the  BCU-VME-1014 
Operations  Manual  to  send  the  altitude  information  subaddress  and  request  subad¬ 
dresses  one  and  sixteen.  A  parameter  block  is  set  to  output  the  messages  at  a  twenty 
Hertz  rate.  Mr.  Clay’s  program  is  modified  to  save  the  requested  data  every  ten 
seconds  for  twenty  minutes.  Also,  the  data  is  scaled  to  the  proper  units,  utilizing 
the  information  in  FNU  85-1,  before  being  saved.  The  INS  is  initialized  to  the  labo¬ 
ratory’s  position  and  allowed  to  align  for  eight  minutes.  The  program  to  collect  the 
data  is  begun  when  the  INS  is  set  to  the  navigation  mode. 

The  program  to  obtain  the  data  from  the  LN-94  is  written  in  the  C  program¬ 
ming  language.  To  utilize  the  data  with  MSOFE,  the  data  must  be  saved  in  an 
unformatted  FORTRAN  readable  file  and  in  the  same  order  as  the  data  supplied 
by  PROFGEN  for  the  fighter  flight  profile.  To  this  end,  a  FORTRAN  program  was 
written  which  read  the  formatted  data  as  output  by  the  C  program  and  wrote  an 
unformatted  file  readable  by  MSOFE.  MSOFE  is  modified  so  as  not  to  read  header 
information  from  the  file  FLIGHT  since  no  header  information  is  provided  in  the 
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empirical  INS  data. 


5.2  Kalman  Filter  Evaluation 

With  the  data  collected  and  interpreted,  MSOFE  is  modified  to  read  the  GPS 
measurement  and  satellite  position  files,  to  utilize  the  data  to  perform  the  measure¬ 
ment  updates,  and  to  calculate  estimates  of  satellite  velocities  at  the  update  times. 
An  eight-minute  alignment  of  the  INS  is  simulated  with  no  GPS  updates,  followed 
by  filter  operation  for  twenty  minutes  of  GPS  pseudorange  and  delta-range  updates 
and  altitude  updates. 

5.2.1  Filter  Operation  On  the  first  attempt  with  empirical  data,  the  filter 
fails  to  update  with  all  four  satellites.  The  residual  monitoring  built  into  MSOFE 
accepts  the  first  channel  update  and  rejects  the  rest.  Subsequently,  the  residuals  for 
all  satellites  become  worse  over  time. 

As  a  first  attempt  to  identify  the  problem,  the  measurement  noise  covariance 
in  the  filter  is  increased  for  all  measurements.  This  results  in  allowing  the  filter  to 
update  with  all  measurements.  The  residuals  are  reduced  in  magnitude  but  remain 
biased  on  the  order  of  10®  feet.  This  indicates  that  there  is  some  unaccounted  error 
which  affects  each  satellite’s  measurements  individually. 

At  this  point,  the  delta-range  updates  are  dropped.  The  filter  can  perform 
adequately  without  the  delta-range  updates,  and  some  problems  experienced  in  the 
filter  simulations  point  out  that  incorrect  delta-range  calculations  can  seriously  de¬ 
grade  performance.  The  delta-range  update  is  thus  dropped  for  the  first  iteration 
to  eliminate  a  possible  source  of  additional  errors.  Also,  the  simulation  time  is  de¬ 
creased  to  five  minutes  during  which  four  satellites  are  used  for  most  of  the  time 
period.  This  allows  for  testing  the  filter  without  introducing  the  increased  errors 
when  fewer  than  four  satellites  are  in  use. 

Having  applied  some  simple  fixes  to  decrease  the  modeling  error,  the  true 
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Figure  5.1.  Range  Drifts  Adjusted  for  Initial  Biases 


ranges  to  the  satellites  are  computed  and  compared  to  the  pseudorange  measure¬ 
ments  supplied  by  the  receiver.  The  true  range  is  subtracted  from  the  pseudorange, 
and  the  initial  biases  are  subtracted  out  so  that  the  numbers  involved  are  smaller 
and  provide  easier  analysis  results.  The  results  of  this  comparison  are  shown  in  Fig¬ 
ure  5.1.  The  initial  biases  for  channels  one  through  four  are:  -77,381,625,  -76,523,193, 
-76.090,289,  and  -76,518,473  feet,  respectively.  It  is  seen  that  there  is  a  large  discrep¬ 
ancy  among  the  biases,  even  to  the  millions  place  in  one  instance.  From  Figure  5.1, 
it  is  obvious  that  the  biases  do  not  have  the  same  drift  either.  The  plot  for  channel 
three  also  noticably  varies  in  ways  which  are  not  attributable  to  either  a  bias  or  a 
drift. 


The  errors  in  evidence  in  Figure  5.1  are  distinctly  biases  with  a  drift.  The  drift 
is  apparent  from  the  errors  growing  in  a  straight  line.  However,  the  biases  and  drift 
rates  are  different  for  each  satellite.  This  suggests  a  phenomenon  which  is  separate 


among  the  satellites.  Also,  the  plots  are  not  perfectly  straight  lines.  Because  of  the 
scales  used  in  the  plots,  channel  three  displays  the  slight  nonlinearity  better  than  the 
other  channels.  This  indicates  a  varying  which  may  be  attributable  to  atmospheric 
delay.  The  code  loop  delay  has  a  one  second  time  constant;  thus,  it  should  not  be 
causing  changes  which  evidence  themselves  after  twenty  seconds  or  more.  Hence,  the 
error  is  attributed  to  atmospheric  delay  error.  Although  there  is  the  possibilty  that 
some  unmodeled  error  is  causing  the  variations.  The  source  of  this  error  is  a  subject 
for  further  investigation 

The  Global  Positioning  System  is  currently  functioning  with  selective  avail¬ 
ability  enabled  at  unannounced  times.  Selective  availability  is  a  method  to  degrade 
the  accuracy  of  non-friendly  receivers  by  denying  access  to  the  P-code.  Selective 
availability  results  in  larger  residuals  and  less  accurate  position  and  velocity  estima¬ 
tion  than  in  a  full  availability  situation.  This  causes  the  filter  performance  to  be 
degraded  from  the  predictions  and  is  an  unvalidated  source  of  substantial  error. 

The  pseudorange  and  delta-range  measurements  and  the  satellite  positions 
provided  by  the  GPSUE  are  output  with  an  associated  GPS  time.  This  time  tagging 
of  the  information  on  the  two  different  busses  is  provided  at  one  second  intervals.  It 
is  possible  that  the  time  tagging  of  the  measurements  is  performed  differently  than 
the  time  tagging  of  the  satellite  position  data.  Also,  the  satellite  positions  may  have 
been  calculated  at  different  times  within  the  one  second  interval.  Time  differences 
as  small  as  a  millisecond  have  a  significant  effect  on  the  value  cf  the  pseudorange. 
This  is  another  area  for  further  study. 

The  first  attempt  to  correct  the  error  is  to  add  bias  and  drift  states  to  each 
satellite  model.  The  attempt  is  suggested  from  the  appearance  of  the  error  as  a  bias 
and  drift  unique  to  each  satellite  and  lack  of  information  about  any  other  processes 
which  display  this  characteristic.  This  effort  reduces  the  residuals  with  the  mea¬ 
surement  noise  values  retained  at  the  values  used  in  the  simulation.  However,  the 
residuals  increase  slowly  with  time. 
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The  next  attempt  to  correct  the  problem  is  to  reduce  the  atmospheric  error 
time  constant  to  100  seconds.  The  decrease  in  the  time  constant  is  suggested  partially 
by  the  errors  displayed  in  plots  of  the  range  errors.  Also,  the  length  of  time  before 
the  residuals  begin  to  grow  larger  appears  to  be  between  one  and  two  minutes.  The 
results  from  this  attempt  are  shown  in  Figure  5.2.  The  residuals  are  slightly  better 
than  in  previous  attempts;  however,  the  position  errors  tend  to  ramp  away  from 
zero.  Also,  the  residuals  still  tend  to  grow  with  time.  Particularly,  the  residuals  in 
channels  one  and  three  display  a  noticable  ramp  at  the  beginning  of  data  processing. 

Further  attempts  to  obtain  an  operational  filter  are  made  by  varying  the  at¬ 
mospheric  error  time  constant,  the  atmospheric  error  driving  noise  strength,  and  the 
measurement  noise  variance.  Results  from  the  best  of  the  attempts  are  presented 
in  Figure  5.3.  The  atmospheric  time  constant  for  this  attempt  is  50  sec.  The  mea¬ 
surement  noise  variance  is  reduced  to  250  ft.2,  and  the  driving  noise  strength  is  set 
to  0.03  ft.2 /sec.  The  residuals  remain  within  a  reasonable  range  around  zero  for  the 
entire  time  period.  With  selective  availability  being  used,  residuals  with  magnitudes 
around  two  hundred  feet  are  not  unexpected.  However,  the  latitude  and  longitude 
errors  still  ramp  away  from  zero.  The  error  in  the  position  estimation  increases  at 
a  slower  rate  than  with  the  atmospheric  time  constant  at  100  sec.  This  is  an  indi¬ 
cation  that  the  tuning  is  proceeding  in  the  proper  direction;  however,  the  intent  is 
to  keep  the  position  errors  from  growing  at  all.  It  may  be  necessary  to  separate  the 
ionspheric  delay  from  the  atmospheric  delay  state.  Using  different  time  constants 
for  the  two  phenomena  may  reduce  the  growth  of  the  latitude  and  longitude  errors 
even  further.  It  is  evident  that  more  work  is  needed  in  analyzing  the  errors  in  the 
pseudoranges. 

5.3  Summary 

Pseudoranges,  delta- ranges,  and  satellite  positions  are  obtained  from  the  GPS 
receiver  through  the  instumentation  port,  and  MSOFE  is  modified  to  utilize  the 
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Latitude  Error  (ft)  Chon  3  PRortge  Residual  (ft)  Chon  1  P Range  Residual  (ft) 


436800  437100  437400  437700 


Time  (sec) 


436800  437100  437400  437700 

Time  (sec) 


Time  (sec) 


Figure  5.2.  Residuals  and  Position  Errors  for  Atmospheric  Time  Constant  100  sec. 


5-8 


Latitude  Error  (ft)  Chan  3  PRonge  Residual  (ft)  Chon  t  PRonge  Residual  (ft) 


436600  437100  437400  437700 

Time  (see) 


436600  437100  437400  437700 

Time  (sec) 

600 


-600  > — - - - — « - - — * — i — * - * — I 

436800  437100  437400  437700 

Time  (sec) 


-600  1 - - - - - i - - - - - i - — ....  1 

436600  437100  437400  437700 

Time  (sec) 


-200  1 — - - - - i - - - - - i - - - - - I 

436600  437100  437400  437700 

Time  (sec) 


5500  ‘ — ■ — ■ — - - - — - — I 

436800  437100  437400  437700 

Time  (sec) 


Figure  5.3.  Residuals  and  Position  Errors  for  Atmospheric  Time  Constant  50  sec. 
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alignment.  Data  is  obtained  from  the  GPSUE  and  INS  at  the  same  time.  The  INS 


data  is  put  in  a  file  in  the  same  form  as  used  by  PROFGEN  to  provide  FLIGHT 


files,  so  MSOFE  only  needs  to  be  modified  to  the  extent  that  no  header  information 


is  read  from  the  FLIGHT  file.  The  filter  is  allowed  to  perform  with  real  data,  and 
errors  are  noted.  The  errors  are  analyzed,  and  some  attempts  to  correct  for  the 
errors  are  made. 
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VI.  Conclusions  and  Recommendations 


All  stated  research  objectives  are  attempted;  most  are  successful,  some  require 
additional  work.  Conclusions  drawn  from  the  research  and  recommendations  for 
further  research  are  discussed, 

6.1  Conclusions 

The  overall  objective  stated  in  the  first  chapter  is  to  integrate  GPS  measure¬ 
ments  with  INS  outputs.  The  first  step  is  to  model  the  two  systems  and  combine 
them  in  a  single  Kalman  filter.  The  INS  model  is  obtained  from  Litton,  programmed 
into  MSOFE,  and  validated.  With  some  small  anomalies,  this  is  accomplished.  The 
anomalies  are  attributable  to  having  performed  a  covariance  analysis;  whereas,  the 
basis  of  comparison  is  the  set  of  sample  statistics  obtained  by  averaging  over  ten 
Monte  Carlo  simulations.  The  INS  truth  model  is  determined  to  be  sufficiently  cor¬ 
rect.  The  GPS  model  is  a  modified  version  of  that  developed  by  Capt  Solomon  (20). 
The  major  difference  is  the  use  of  a  single  user  clock  error  rather  than  separate  clock 
errors  for  the  separate  satellites.  The  GPS  model  is  programmed  into  MSOFE,  and 
the  states  behave  as  predicted.  Thus,  the  GPS  model  is  deemed  to  be  correct. 

The  next  step  is  to  combine  the  two  models  and  predict  the  performance  of 
the  joint  Kalman  filter  processing  empirical  data.  A  simulation  of  the  full  state 
filter  running  against  the  truth  model  is  performed  to  this  end.  The  residuals  from 
the  pseudorange  and  delta-range  updates  remain  within  expected  bounds,  and  the 
position  and  velocity  errors  also  remain  relatively  close  to  zero.  Thus,  the  filter  is 
determined  to  be  correctly  implemented.  Inability  of  the  GPS  model  to  obtain  good 
estimation  of  the  code  loop  error  indicates  that  this  state  may  be  a  candidate  for 
removal  when  filter  reduction  is  performed  in  later  research.  The  estimation  errors 
in  the  satellite  position  errors  indicate  a  possibility  to  condense  the  three  satellite 


6-1 


position  states  into  one  state  along  the  current  line-of-sight  when  filter  reduction  is 
performed. 

The  final  step  is  to  process  empirical  data  through  the  filter.  This  step  is 
not  completely  accomplished.  The  data  is  obtained  to  operate  the  filter,  but  filter 
performance  is  well  below  that  which  is  predicted.  Analysis  of  the  data  indicates 
that  the  filter  could  possibly  be  tus  ed  more  carefully  to  alleviate  the  problem,  or 
that  the  GPS  model  may  need  to  be  changed  to  account  for  the  errors  observed. 
Some  small  changes  are  made  to  the  filter  which  clean  up  the  residuals  reasonably, 
but  the  position  errors  remain  unacceptable. 

6.2  Recommendations 

Some  ideas  for  further  research  are  presented  below.  These  areas  will  provide 
useful  information  with  which  to  obtain  better  filter  performance  with  the  empirical 
data. 


6.2.1  Discover  and  Fix  Problem  with  Pseudoranges  It  is  possible  that  the 
ranges  compared  with  the  pseudoranges  are  being  incorrectly  calculated.  If  this 
is  the  case,  discovering  this  problem  and  fixing  it  should  clear  up  most  of  the  errors 
being  experienced. 

6.2.2  Further  Analyze  the  Discrepancies  in  the  Data  Other  errors  are  in  evi¬ 
dence  than  just  the  large  bias  problem.  Analysis  and  resolution  of  these  discrepancies 
will  serve  to  improve  filter  performance  further. 

6.2.3  Tune  the  Filter  Tuning  the  filter  using  the  empirical  data  (corrected 
for  errors  if  necessary)  will  provide  improved  filter  performance.  The  closer  the  filter 
is  to  modeling  the  “real”  world,  the  better  the  filter  performance  will  be. 
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6.2.4  Reevaluate  the  GPS  Error  Model  A  reevaluation  of  the  GPS  error 
model  to  determine  correctness  will  be  useful.  If  the  model  is  significantly  differ¬ 
ent  from  what  is  actually  occurring,  filter  performance  will  be  degraded.  This  is  a 
possible  explanation  for  some  of  the  problems  encountered  here. 

6.2.5  Check  Data  Time  Tagging  If  time  tagging  of  the  pseudorange  and 
delta-range  information  is  performed  differently  from  the  time  tagging  of  the  satel¬ 
lite  positions,  a  significant  error  could  result  from  even  a  difference  in  time  as  small 
as  a  millisecond.  Closer  examination  of  how  the  time  tagging  of  the  information  is 
performed  may  reduce  some  of  the  errors  evident  here. 

6.2.6  More  Filter  Simulations  One  Monte  Carlo  anaylsis  was  performed  in 
the  combined  model  prediction.  Performing  more  Monte  Carlo  runs  to  validate  the 
analysis  in  Chapter  4  may  yield  more  insight  to  the  problems  encountered. 

6.2.7  Horizontal  Velocity  Errors  The  horizontal  velocity  error  biases 
displayed  in  the  filter  performance  prediction  need  to  be  studied.  The  delta-range 
and  altitude  updates  are  possible  sources  for  this  error  as  stated  in  Chpater  4.  Re¬ 
moving  these  biases  may  improve  filter  performance. 

6.2.8  Code  Loop  Estimation  The  filter  does  a  very  poor  job  of  estimating  the 
code  loop  error.  Further  investigation  as  to  the  cause  of  this  poor  estimation  should 
be  considered.  Possible  sources  for  this  problem  are  that  the  code  loop  delay  state 
is  unobservable,  and  that  the  driving  noise  strength  on  this  state  is  too  small. 

6.2.9  Satellite  Position  Errors  The  filter  also  does  a  poor  job  of  estimating 
the  satellite  position  errors  during  performance  prediction.  This  is  attributed  to 
both  the  satellites  and  the  GPS  unit  being  stationary  during  the  simulation.  More 
work  needs  to  be  done  to  verify  that  this  is  the  case.  Simulating  either  satellite  or 
aircraft  movement  will  verify  whether  or  not  this  is  true. 
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Appendix  A.  INS  Truth  Model  State  Definitions 


The  truth  model  is  composed  of  93  states  that  are  all  errors  committed  by 
the  LN-94.  The  state  number  used  in  MSOFE,  the  state  symbol  as  used  in  the 
Litton  CDRL  (14),  and  a  short  definition  of  each  state  are  given  here.  The  states 
are  shown  in  tables  which  are  broken  into  the  state  subvectors  defined  previously. 
(Note:  The  state  symbol  here,  Sfc ,  is  given  by  Litton  as  The  change  here  is 
to  remove  confusion  between  all  the  terms  which  are  symbolized  by  4>  in  the  Litton 
CDRL.) 


Table  A.l.  Definition  of  INS  Truth  Model  Subvector  6x* 


State 

Number 

iwcff  * '  vS6j 

E3E53SI 

Definition 

1 

66x 

X-component  of  vector  angle  from  true  to  computer  frame 

2 

wwm 

Y-component  of  vector  angle  from  true  to  computer  frame 

3 

66, 

Z-component  of  vector  angle  from  true  to  computer  frame 

4 

mm 

X-component  of  vector  angle  from  true  to  platform  frame 

5 

64>y 

Y-component  of  vector  angle  from  true  to  platform  frame 

6 

6<t>» 

Z-component  of  vector  angle  from  true  to  platform  frame 

7 

6Vt 

X-component  of  error  in  computed  velocity 

8 

mm 

Y-component  of  error  in  computed  velocity 

9 

6V, 

Z-component  of  error  in  computed  velocity 

10 

6h 

Error  in  vehicle  altitude  above  reference  ellipsiod 

11 

6hL 

Error  in  lagged  inertial  altitude 

12 

Error  in  vertical  channel  aiding  state 

13 

SS4 

Error  in  vertical  channel  aiding  state 
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Table  A.2.  Definition  of  INS  Truth  Model  Subvector  6x2 


State 

Number 

State 

Symbol 

Definition 

14 

K 

X-component  of  gyro  correlated  drift  rate 

15 

K 

Y-cornponent  of  gyro  correlated  drift  rate 

16 

b,c 

Z-component  of  gyro  correlated  drift  rate 

17 

m 

X-component  of  accelerometer  and 
velocity  quantizer  correlated  noise 

18 

m 

Y-component  of  accelerometer  and 
velocity  quantizer  correlated  noise 

19 

Z-component  of  accelerometer  and 
velocity  quantizer  correlated  noise 

20 

bgx 

X-component  of  gravity  vector  errors 

21 

Y-component  of  gravity  vector  errors 

22 

Sgx 

Z-component  of  gravity  vector  errors 

23 

mm 

Barometer  correlated  bias  noise  error 

24 

b„ 

X-component  of  gyro  trend 

25 

byt 

Y-component  of  gyro  trend 

26 

btt 

Z-component  of  gyro  trend 

27 

vtt 

X-component  of  accelerometer  trend 

28 

mm 

Y-component  of  accelerometer  trend 

29 

Z-component  of  accelerometer  trend 

Table  A. 3.  Definition  of  INS  Truth  Model  Subvector  6x3 


State 

Number 


30 


31 


32 


33 


34 


35 


36 


37 


38 


39 


40 

41' 


42 


43 


44 


45 


46 


47 


State 

Symbol 


b. 


is* 


tlL- 


Xi 


X2 


X3 


V\ 


Vi 


^3 


D, 


D 


MV 


Dt 


Sqbv 


SQb. 


Definition 


X-component  of  gyro  drift  rate  repeatability 

Y-component  of  gyro  drift  rate  repeatability 
7  rzrrrrrii  _ htfz _ * _ _ -um:*.. 


- l  -  ov - - - -  r  - w 

Z-component  of  gyro  drift  rate  repeatability 
X-component  of  gyro  scale  factor  error 


Y-component  of  gyro  scale  factor  error 


Z-component  of  gyro  scale  factor  error 


X  gyro  misalignment  about  Y-axis 


Y  gyro  misalignment  about  X-axis 


Z  gyro  misalignment  about  X-axis 


X  gyro  misalignment  about  Z-axis 


Y  gyro  misalignment  about  Z-axis 


Z  gyro  misalignment  about  Y-axis 


X  gyro  scale  factor  non-linearity 


Y  gyro  scale  factor  non-linearity 


Z  gyro  scale  factor  non-linearity 


X  gyro  scale  factor  asymmetry  error 


Y  gyro  scale  factor  asymmetry  error 


Z  gyro  scale  factor  asymmetry  error 
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Table  A. 4.  Definition  of  INS  Truth  Model  Subvector  £x4 


State 

Number 

mmrmi 

Definition 

48 

sa 

X-component  of  accelerometer  bias  repeatability 

49 

Y-component  of  accelerometer  bias  repeatability 

50 

Z-component  of  accelerometer  bias  repeatability 

51 

54, 

X-component  of  accelerometer  and  velocity 
quantizer  scale  factor  error 

52 

54V 

Y-component  of  accelerometer  and  velocity 
quantizer  scale  factor  error 

53 

Z-component  of  accelerometer  and  velocity 
quantizer  scale  factor  error 

54 

5<J4, 

X-component  of  accelerometer  and  velocty 
quantizer  scale  factor  asymmetry 

55 

Sqav 

Y-component  of  accelerometer  and  velocty 
quantizer  scale  factor  asymmetry 

56 

Sqa, 

Z-component  of  accelerometer  and  velocty 
quantizer  scale  factor  asymmetry 

57 

fxx 

Coefficient  of  error  proportional  to  square 
of  measured  acceleration 

58 

fvv 

Coefficient  of  error  proportional  to  square 
of  measured  acceleration 

59 

f" 

Coefficient  of  error  proportional  to  square 
of  measured  acceleration 

60 

fxy 

Coefficient  of  error  proportional  to  products  of  accel¬ 
eration  along  and  orthogonal  to  acceleromter  sensitive  axis 

61 

fx. 

Coefficient  of  error  proportional  to  products  of  accel¬ 
eration  along  and  orthogonal  to  acceleromter  sensitive  axis 

62 

fyx 

Coefficient  of  error  proportional  to  products  of  accel¬ 
eration  along  and  orthogonal  to  acceleromter  sensitive  axis 

63 

wm 

Coefficient  of  error  proportional  to  products  of  accel¬ 
eration  along  and  orthogonal  to  acceleromter  sensitive  axis 

64 

Hi 

Coefficient  of  error  proportional  to  products  of  accel¬ 
eration  along  and  orthogonal  to  acceleromter  sensitive  axis 

65 

/.V 

Coefficient  of  error  proportional  to  products  of  accel¬ 
eration  along  and  orthogonal  to  acceleromter  sensitive  axis 

66 

Hi 

X  accelerometer  misalignment  about  Z-axis 

67 

Hi 

Y  accelerometer  misalignment  about  Z-axis 

68 

H3 

Z  accelerometer  misalignment  about  Y-axis 

&3 

Z-accelerometer  misalignment  about  X-axis 

Table  A.6.  Definition  of  INS  Truth  Model  Subvector  6x* 


KS3I 

State 

Symbol 

Definition 

76 

■n 

X  gyro  compliance  term 

77 

BS 

X  gyro  compliance  term 

78 

Mgm 

X  gyro  compliance  term 

79 

■a 

X  gyro  compliance  term 

80 

wrnmm 

X  gyro  compliance  term 

81 

X  gyro  compliance  term 

82 

mmm 

Y  gyro  compliance  term 

83 

warn 

Y  gyro  compliance  term 

84 

Y  gyro  compliance  term 

85 

mmm 

Y  gyro  compliance  term 

86 

■a 

Y  gyro  compliance  term 

87 

HEiffSI 

Y  gyro  compliance  term 

88 

HLffl 

Z  gyro  compliance  term 

89 

■a 

Z  gyro  compliance  term 

90 

F,„  | 

Z  gyro  compliance  term 

91 

BCff 

Z  gyro  compliance  term 

92 

KOI 

Z  gyro  compliance  term 

93 

Z  gyro  compliance  term 
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Appendix  B.  Initial  INS  Covariance  Matrix  Values 

The  covariance  matrix  prior  to  alignment  is  a  diagonal  matrix  where  the  diag¬ 
onal  terms  are  the  variances  of  the  states.  The  off-diagonal  terms  are  the  covariances 
between  states.  Since  the  covariance  terms  are  all  zero,  they  are  not  provided  in  the 
following  tables.  The  variances  are  broken  into  six  tables,  one  table  for  each  state 
subvector. 


Table  B.l.  Initial  Variances  for  Subvector  <5xi 


State 

1  a  Value  for 
Static  Navigation 

1<7  Value  for 
Fighter  Flight 

1 

0  rad 

0  rad 

2 

0  rad 

0  rad 

3 

0  rad 

0  rad 

4 

1800  sec 

1800  sec 

5 

1800  sec 

1800  sec 

6 

1800  sec 

1800  sec 

7 

0  fps 

0  fps 

8 

0  fps 

0  fps 

9 

0  fps 

0  fps 

10 

0  ft 

Oft 

11 

0  ft 

Oft 

12 

0  ft 

Oft 

13 

0  fps* 

0  fps1* 
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Table  B.2.  Initial  Variances  for  Subvector  6x2 


State 

1<7  Value  for 
Static  Navigation 

1<7  Value  for 
Fighter  Flight 

14 

0°/hr. 

0.002°/hr. 

15 

0°/hr. 

0.002°/hr. 

16 

0°/hr. 

0.002°/hr. 

17 

2  Mg 

2  Mg 

18 

2  Mg 

2  Mg 

19 

2  Mg 

2  Mg 

20 

0  sec 

5  sec 

21 

0  sec 

5  s'ec 

22 

0  sec 

0  s'ec 

23 

0  ft. 

100  ft. 

24 

O.OOOr/hr./hr. 

■«a 

25 

0.0001o/hr./hr. 

0.0001°/hr./hr. 

26 

0.0001°/hr./hr. 

27 

1  Mg/hr. 

■DZ929H 

28 

■Dm 

1  Mg/hr. 

29 

■■ZESiSMi 

1  Mg/hr. 
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Table  B.3.  Initial  Variances  for  Subvector  Sx 3 


State 

la  Value  for 
Static  Navigation 

la  Value  for 
Fighter  Flight 

30 

0.003® /hr. 

0.003® /hr. 

31 

0.003® /hr. 

0.003° /hr. 

32 

0.003® /hr. 

0.003®/hr. 

33 

0.0005% 

0.0005% 

34 

0.0005%  “  ' 

0.0005% 

35 

0.0005% 

0.0005% 

36 

1.5  sec 

1.5  sec 

37 

1.5  sec 

1.5  sec 

38 

0  sec 

1.5  sec 

39 

0  sec 

1.5  sec 

40 

1.5  sec 

1.5  sec 

41 

1.5  s'ec 

1.5  sec 

\mm 

ISBjfl23HGEKEM 

43 

0(°/hr.)/(rad/sec.)2 

0.5(®/hr.)/(rad/sec.)2 

44 

0.5(°/hr.)/(rad/sec.)2 

O.S^/hr.y^rad/sec.)11 

45 

1  ppm 

1  ppm 

46 

0  ppm 

1  ppm 

47 

1  ppm 

1  ppm 
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Table  B.5.  Initial  Variances  for  Subvector  6x5 


State 

1<7  Value  for 
Static  Navigation 

1<t  Value  for 
Fighter  Flight 

70 

6pg 

71 

6/ig 

6/*g 

72 

0/ig 

6/*g 

73 

wmEL&Eam 

0.003°/hr. 

74 

■sm 

75 

Km 
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Table  B.6.  Initial  Variances  for  Subvector  Sxe 


State 

1  a  Value  for 

1(7  Value  for 

Static  Navigation 

Fighter  Flight 

76 

0  sec/g 

0.3  sec/g 

77 

0  sec/g 

0.3  sec/g 

78 

0  sec/g 

0.3  sec/g 

79 

0  sec/g 

0.3  sec/g 

80 

0.3  sec/g 

0.3  sec/g 

81 

0.3  sec/g 

0.3  sec/g 

82 

0.3  sec/g 

0.3  sec/g 

83 

0.3  sec/g 

0.3  sec/g 

84 

0  sec/g 

0.3  sec/g 

85 

0  sec/g 

0.3  sec/g 

86 

0  sec/g 

0.3  sec/g 

87 

0  sec/g 

88 

—  I'Tf 

0.3  sec/g 

89 

0.3  3ec/g 

kb 

0  sec/g 

91 

0  sec/g 

0.3  sec/g 

92 

0  sec/g 

0.3  sec/g 

93 

0  sec/g 
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Appendix  C.  Elements  of  the  INS  Truth  Model  Dynamics  Matrix 

The  INS  truth  model  dynamics  matrix  is  a  93  by  93  matrix.  This  matrix  is 
broken  into  submatrices  which  are  defined  in  the  text.  The  non-zero  elements  of  the 
submatrices  are  shown  here.  Each  element  is  referred  to  by  its  place  in  the  overall 
dynamics  matrix,  not  by  its  position  in  the  submatrix.  The  elements  of  the  C£, 
sensor-to-true,  matrix  are  used  here  as  Cy  where  i  is  the  row  and  j  is  the  column  in 
the  transformation  matrix. 


C-l 


Table  C.l.  Elements  of  the  Dynamics  Submatrix  Fn 
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Table  C.2.  Elements  of  the  Dynamics  Submatrix  F12 


Element  Term  Element  Term  Element  Term 


■eom 

C\2 

WSSMMSm 

■aa* 

Cut 

mmm 

C12 1 

(8,17) 

C21 

(8,18) 

C*22 

(8,21) 

1 

IffiSOI 

C^t 

(8,29) 

Ci$t 

(9,17) 

C31 

■®EEn 

C33 

(9,22) 

1 

Cut 

C32/ 

mm 

Table  C.3.  Elements  of  the  Dynamics  Submatrix  F13 


Element  I  Term  II  Element  |  Term  ||  Element  |  Term 


(4,30) 


(4,33) 


(4,45) 


(5,30) 


Cnu?h 


0.5Cn|w# 


(5,39) 

— 

Cnu>ib 

(5,42) 

0.5C2i 


C31 


m 


5C3i  Iw.f,,  | 


(4,31) 


(4,34) 


(4,37) 


(4,40) 


(4,43) 


(4,46) 


(5,31) 


(5,46) 


(6,31) 


C 


Cl2Uljb 


0.5C12 


2 


-C 

C2 

CnVib, 

0.5^22 


C32 


(6,40) 


(6,43) 


(6,46)  |  0.5C32|u?rt 


(4,41) 


(4,44) 


(4,47) 


(6,35) 


(6,38) 


(6,41) 


(6,44) 


Cl3 


0.5Cj3  WrtJ 


&23 


-C  33w<6 


Cnu>l 


O.5C33  | 


Table  C.4.  Elements  of  the  Dynamics  Submatrix  F14 


Element  Term 


C\\ 


(7,51) 


Cm  A 


(7,57) 


Element 


(9,67) 


(7,52) 


(7,58) 


(7,61) 


(7,64) 


(8,51) 


(8,54) 


(8,57) 


(8,60) 


(8,66) 


(9,53) 


(9,56) 


(9,59) 


(9,62) 


(9,65) 


(9,68) 


Term 


C 


C 


Cn\A°\ 


C 


—C\  2A 


C21 


Cm  A*  | 


C23A 


C33 


Element  I  Term 


(7,50)  C13 


(7,53)  |  C,3A 


(7,56) 


(7,59) 


(7,62) 


(7,65) 


(7,68)  Cl3A 


(8,49) 


(8,52) 


(8,55) 


(8,58) 


(8,61) 


(8,64)  |C23A"A 


(8,67)  -C22A 


(9,48)  |  C« 


(9,54) 


(9,57) 


(9,60) 


(9,63) 


(9,66) 


(9,69) 


C33.A 


Table  C.5.  Elements  of  the  Dynamics  Submatrix  F15 


Table  C.6.  Elements  of  the  Dynamics  Submatrix  Fia 


Element 


M 


4,79) 


*,82) 


4,85) 


4,88 


M 


(5J9) 


(5,82) 


US 


(5,88) 


(5,91) 


(6,76) 


(6,79) 

tm 


(6,85) 


(6,88) 


(6,91) 


Term 


CnA*juibM 


CnAfuib 


CuAfujjb, 

CxtAgUjb, 


C\zA%Uibv 


C13A*Uib, 


CnA* 
r>  ab 


W<6, 


CnAfu^ 

CnAfuib] 


C-nA*uiib, 
C23A-  U>ibM 


& 


@23  AyUJib, 


@3\AyU>ibM 


@31  A^Ujbu 


@32AMJdjba 


@ 32  A^Uib, 


@33AgUjbw 

r» aB,.,. 


@33  Av  u>jba 


Element 


±4-77) 


(4,80) 


(4,83) 


(4,86) 


4,89) 


4,92) 


IM 

IW 


(5,83) 


(5,86) 


(5,89) 


(5,92) 


(6,77) 


(6,80) 


(6,83) 


(6,86) 

(6,89) 


(6,92) 


Term 


@nA£u}ibu 

isT 


GnAfuib, 

\o, 


GuAfuib, 


@nAx  u \ba 


CuA^Uib, 

CttAyUiby 


V- 

C7\A*!jJib 


C2iAfuib. 

CiiA^Uib, 


c^Af^r 


@23A*Uib. 


@31  AzUib, 

7b 


@31  AfuJib, 

C32  A?Wjb. 


C 32  AxU)ibs 

o, 


C33A*<jJiba 

@33AyU>iby 


Element 


(4,78) 


(4,81) 


(4,84) 


(4,87) 


(4,90) 


(4,93) 


(5,78) 


(5,81) 


(5,84) 


(5,87) 


(5,90) 


(5,93) 


(6,78) 


(6,81) 


(6,84) 


(6,87) 


(6,90) 


(6,93) 


Term 


@uAycJjb^ 

I B, 


Cn  Afo>,6t 


C 12  A*  ujby 


CiiAZuib^ 


C\3A%tx>ib, 


CizA^Uib, 


@21  A^Uiby 


@21  AaU>ibz 


@22AjUjb1L 


@22Ax  U>iby 


@23-A?UJib, 
@23  Ay  u>ib. 


C 3i  Ay  u>ibx 
B, 


@3lAjU>ibx 


@32  A^wiby 
@32  AxUJiby 


C33A*U)ib, 


Table  C.7.  Elements  of  the  Dynamics  Submatrix  F22 


Element 

Term 

Element 

Term 

Element 

Term 

(14,14) 

mm 

-Ac_ 

(16,16) 

mm 

(17,17) 

mm 

■ibbm 

mm 

ITtiJIUll 

(20,20) 

mm 

(21,21) 

mm 

WSffiSM 

mm 

1BSMI 

-06he 

wmm 

■Hi 

Table  C.8.  Elements  of  the  Dynamics  Submatrix  F55 


Element 

Term 

Element 

Term 

Element 

Term  | 

(70,70) 

(71,71) 

mam 

mmsm 

Ban 

(73,73) 

mm 

mm 

(75,75) 
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Appendix  D.  Elements  of  the  Process  Noise  Matrix 

The  process  noise  matrix  contains  mostly  zeros.  The  matrix  was  subdivided 
into  two  submatrices  which  contain  the  non-zero  elements  and  a  number  of  zero 
matrices.  Only  the  non-zero  elements  of  the  submatrices  are  shown  here.  The 
elements  are  referred  to  by  their  placement  in  the  overall  matrix,  not  their  placement 
in  the  submatrices. 

Table  D.l.  Non-zero  Elements  of  Process  Noise  Submatrix  Qn 


Element 

Term 

Element 

Term 

(4,4) 

< 

(5,5) 

(6,6) 

(7,7) 

(8,8) 

(9,9) 

< 

Table  D.2.  Non-zero  Elements  of  Process  Noise  Submatrix  Q22 


|  Element 

Term 

Element 

Term 

(14,14) 

WBSM 

■tatan 

J 

gtntEM 

IMI 

(17, IT) 

(18,18) 

(18,18) 

EH3K9I II 

(20,20) 

2&s  ,*L 

(21,21) 

(22,22) 

mmm 

(23,23) 

mmm 
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Appendix  E.  Instrumentation  Port  Block  1 022  Definition  File 


The  block  definition  file  for  block  1022  from  the  GPS  receiver’s  instrumentation 
port  is  shown  below.  Explanations  of  each  column  may  be  found  in  Chapter  5.  The 
block  definition  file  is  necessary  for  post  processing  interpretation  of  data  collected 
with  PC  Buffer  Box. 


BDF  BLOCK  1022  FILTER  OBSERVATION  BLOCK 


TIME 

1022 

1 

4 

R 

MEAS_TIME_TAG 

1022 

5 

3 

CF 

MEAS.COUNT 

1022 

8 

1 

I 

MEAS_TYPE_1 

1022 

9 

1 

I 

MEAS.TYPE.2 

1022 

10 

1 

I 

MEAS.TYPE.3 

1022 

11 

1 

I 

MEAS_TYPE_4 

1022 

12 

1 

I 

MEAS_TYPE_5 

1022 

13 

1 

I 

MEASJ1'YPE_6 

1022 

14 

1 

I 

MEAS.TYPE_7 

1022 

15 

1 

I 

MEAS.TYPE.8 

1022 

16 

1 

I 

MEASJTYPE_9 

1022 

17 

1 

I 

MEAS_TYPE_10 

1022 

18 

1 

I 

MEAS.TYPE.ll 

1022 

19 

1 

I 

PSEUDO.RNG.l 

1022 

20 

3 

CF 

PSEUDO.RNG.2 

1022 

23 

3 

CF 

E-l 


PSEUD0_RNG_3 

1022 

26 

3 

CF 

PSEUD0.RNG.4 

1022 

29 

3 

CF 

PSEUD0.RNG.5 

1022 

32 

3 

CF 

DELTA.RNG.l 

1022 

35 

2 

CF 

DELTA.RNG.2 

1022 

37 

2 

CF 

DELTA_RNG_3 

1022 

39 

2 

CF 

DELTA_RNG_4 

1022 

41 

2 

CF 

DELTA_RNG_5 

1022 

43 

2 

CF 

ALTITUDE_MEAS 

1022 

45 

2 

CF 

PRED_PSU_RN  G_1 

1022 

47 

3 

CF 

PRED_PSU_RNG_2 

1022 

50 

3 

CF 

PRED_PSU_RN  G_3 

1022 

53 

3 

CF 

PRED_PSU_RN  G_4 

1022 

56 

3 

CF 

PRED_PSU_RNG_5 

1022 

59 

3 

CF 

PRED_DEL_RNG_1 

1022 

62 

2 

CF 

PR  ED_DEL_RN  G_2 

1022 

64 

2 

CF 

PRED.DEL.RNG.3 

1022 

66 

2 

CF 

PRED_DEL_RNG_4 

1022 

68 

2 

CF 

PRED_DEL_RN  G_5 

1022 

70 

2 

CF 

PRED.DELJRN  G_6 

1022 

72 

2 

CF 

SVJD.l 

1022 

74 

1 

I 

SV_ID_2 

1022 

75 

1 

I 

SV.ID.3 

1022 

76 

1 

I 

SVJD.4 

1022 

77 

1 

I 

SV.ID_5 

1022 

78 

1 

I 

SV.ID.6 

1022 

79 

1 

I 

SVJD.7 

1022 

80 

1 

I 

SV.ID.8 

1022 

81 

1 

I 
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SVJD.9 

1022 

82 

1 

I 

SVJD.10 

1022 

83 

1 

I 

SVJD.11 

1022 

84 

1 

I 

CHAN_ID_1 

1022 

85 

1 

I 

CHAN_ID_2 

1022 

86 

1 

I 

CHANJD.3 

1022 

87 

1 

I 

CHAN.ID.4 

1022 

88 

1 

I 

CHAN_ID_5 

1022 

89 

1 

I 

CHAN.ID.6 

1022 

90 

1 

I 

CHANJD.7 

1022 

91 

1 

I 

CHAN_ID_8 

1022 

92 

1 

I 

CHANJD.9 

1022 

93 

1 

I 

CHAN_ID_10 

1022 

94 

1 

I 

CHAN.ID.ll 

1022 

95 

1 

I 
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Appendix  F.  Errata  for  LN-93  INS  Truth  Model 

The  document  containing  the  truth  model  for  the  LN-94  contains  a  number  of 
discrepancies  and  omissions.  This  is  a  list  of  the  errors  discovered  in  the  document 
listed  by  page  and  section  if  multiple  sections  are  on  a  single  page. 

page  6 

"A*."  Should  be  "faC 

"fib,cn  —  1/10  per  min.,  not  the  5  min.  correlation  time  that  is  shown. 

”/?v,c”  —  1/5  per  min.,  not  the  10  min.  correlation  time  that  is  shown. 

”  =  1/600  per  sec.,  not  the  60  sec.  correlation  time  that  is  shown. 

page  7 
Section  3.1 

n69g  =  "  should  be  nS9g  =  ” 

”66y  =  "  should  be  "60y  =  ” 

9  69,  =  "  should  be  n69x  =  ” 

Section  3.2 

n<t>x  —  ”  should  be  =  ” 

in  the  <j>s  equation,  should  be  nu>x<f>y" 

"<f>y  =  ”  should  be  "<frv  =  ” 

”<j>x  =  ”  should  be  *ix  =  ” 


F-l 


Section  3.3 


"6VX  =  *  should  be  n6Vx  =  ” 
n6Vv  =  "  should  be  ”6Vy  =  w 

page  8 

To  make  the  equations  reflect  the  fact  that  Litton  used  Shs  =  6hc 

in  the  6VX  equation,  ”A:2<5/i,b’’  should  be  ”fc26/ie” 
in  the  6h  equation,  ” kiShs ”  should  be  nkl8hcn 

in  the  6S3  equation,  ”  —  fc3 Shs”  should  be  ”  —  k3Shc” 

•  • 
in  the  6S4  equation,  ”  —  k^Shs”  should  be  ”  —  k\6h c” 

Shs  —  5hc 
Also, 

in  the  6S4  equation,  "k^Shi?  should  be  "k^Shi' 
page  9 

in  the  Crx  equation,  ”  —  2Cyv”  should  be  ”  —  2 CYx" 
nCx»  =  "  should  be  nCx ,  =  ” 

”Cxv  =  ”  should  be  ”Cxv  =  ” 

” Cxm  —  ”  should  be  "C*,  =  ” 

*CYx  =  "  should  be  nCYx  =  ” 

”CYy  =  "  should  be  nCYy  =  » 

”Cy,  =  "  should  be  "CYz  =  ” 
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page  10 


CxM  =  SA(0)C*(0) 

page  18 

"  =  (6^)C‘/60 sec”  should  be  "  =  (6/i<7)e«/«°sec” 
page  21 

6S4  =  (J fc4  —  1  )£S4  +  kA6h.L  -  kAShc.  Omit  rest  of  line, 
page  22 

element  (6,2),  should  be  "Cm” 
page  23 

element  (5,12),  ”  —  C23W*” 
page  24 

element  (7,6),  nC\^A'” 
element  (8,6),  "CisA'” 
element  (8,12), 
element  (9,12),  "Cx*  A?" 
element  (7,19),  ”CuAy” 
element  (8,19),  "CjiAy” 
element  (9,19),  ”C3iAy” 
element  (7,20),  ”  —  CjjA*." 
element  (8,20),  ”  —  C23A*” 
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element  (9,20),  w  —  C^Ax” 
page  26 

heading  of  column  10  should  be 
heading  of  column  11  should  be  ”  FVtx  n 
element  (4,11),  "CuAxUx” 
element  (5,11),  1'CnAxus'n 
element  (6,11),  '"CmAxUJx" 

page  36 

gyro  compliance  errors  are  in  arcseconds/g  not  seconds/g 
Other  errors  and  discrepancies: 

It  is  never  stated  that  a $hc  —  100  ft.  for  the  simulation. 

The  following  are  some  notes  about  items  which  may  escape  attention  in  the 
truth  model  document  because  of  their  placement  in  the  text. 

Notes: 

w’s  and  A' a  in  the  t  and  V  equations,  on  pages  14  and  17  respectively,  are 
referenced  in  the  body  frame. 

Different  sets  of  initial  errors  and  driving  noises  are  used  for  different  navigation 
simulations. 

Only  four  of  the  six  accelerometer  misalignment  errors  are  used  in  the  truth 
model. 
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Appendix  G.  Litton  Error  Plots  for  Static  Navigation  and  Flight 


The  error  plots  provided  by  Litton  for  comparison  of  navigation  simulations 
are  presented  here.  The  errors  for  the  static  navigation  case  are  presented  in  the 
first  two  figures,  followed  by  the  errors  for  the  fighter  flight  profile. 
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Figure  G.3.  Litton  Fighter  Flight  Errors 
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Figure  G.4.  Fighter  Flight  Errors 
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